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ABSTRACT 


A position measuring system for a remotely controlled video camera was designed 
and built. The camera is intended to be used with the modified Advance Development 
Model of the AN/SAR-8 Infrared Search and Target Designation System (IRSTD) in 
use at the Naval Postgraduate School. The video data collected by the camera will be 
correlated with the infrared data from the IRSTD to develop a background data base 
that will be used in the developement of signal processing algorithms. 

The measurement system uses two Hewlett Packard HEDS-6000 incremental optical 
encoders, two Motorola MC68705U3 microprocessors and two digital display devices to 
measure and present the camera’s azimuth and elevation angles to an operator at a re- 
mote location. The azimuth can be measured over a range of 360° with a resolution of 
+ 0.0213° and the elevation can be measured over 24° with a resolution of + 0.138%. 
The resolution is limited primarily by hysteresis, which is due to the backlash in the gears 


between the transducers and the axes of interest. 


THESIS DISCLAIMER 


The reader 1s cautioned that computer programs developed in this research may not 
have been exercised for all cases of interest. While everv effort has been made, within 
the time available, to ensure that the programs are free of computational and logic er- 
rors, they cannot be considered validated. Anv application of these programs without 
additional verification is at the risk of the user. 
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I. INTRODUCTION 


A. BACKGROUND 

The old saying that “every solution breeds new problems”, while somewhat pessi- 
mustic, quite often rings true in today’s increasingly technical world. One such example 
is the use of infrared (IR) sensors for the detection, tracking and/or identification of 
targets in a combat environment. IR sensors are ideally suited for use on today’s bat- 
tlefield. They are passive, i.e., they do not need to emit energy in order to detect the 
presence of potential targets. This allows them to operate during times of emission 
control when many other target detection systems are useless. They have the ability to 
“see through” many forms of camouflage and concealment, dust, clouds, smoke, etc., 
that might otherwise afford an enemy target a safe haven. Additionally, because almost 
evervthing on today’s battlefield generates some degree of infrared energy, IR sensors 
can be used to locate and identify a wide variety of targets. 

The extent to which a particular IR sensor is useful depends primarily on its ability 
to detect and identify targets reliably and accurately. Detection of the target is primarily 
a function of the IR sensor's sensitivity. The classification of a received IR signal as a 
potential target or as background noise, while still dependant on the sensitivity of the 
sensors, 18 primarily a function of the quality of the signal processing algorithms being 
used to process the received signals. In addition to being reliable these algorithms must 
be able to process the received signals in “real time” if the system is to be an effective 
Weapons system. 

Creation of a background data base that can be used to test some of these algo- 
rithms has been one of the tasks being performed by the Naval Academic Center for 
Infrared Technology (NACIT) located at the Naval Postgraduate School (NPS). The 
Advanced Development Model (ADM) of the AN/SAR-8 was sent to the NACIT in 
January of 1984 from the Naval Surface Weapons Center (NSWC) at Dahlgren, 
Virginia. The ADM was modified, calibrated and placed in service at NPS in December, 
1987. The modified version of the ADM, the Infrared Search and Target Designation 
(IRSTD) System, is currently operational at NPS. [Ref: 1: pp. 8-12] 

One wavy to enhance the usefulness of the IR data being collected at NPS would be 
to collect video data concurrently with the IR data. A video image of a portion of the 


horizon would permit visual identification of IR sources in that region. This additional 


tional information could be an aid in the development of the signal processing algo- 
rithms for the IRSTD. Accordingly, a decision to proceed with video data collection 
was made by NACIT, and a camera system was purchased. Components of the system 
include; 

¢ RCA (TC1005/01), Closed circuit video camera. 

e PELCO (AI700), Automatic iris servo. 

¢ PELCO (F1.5X), 1.5 times range extender. 

e PELCO (MLZO6DT), Desk top lens remote control module. 

®e PELCO (PTI250DC), Heavy duty Pan/Tilt servo. 

¢ PELCO(MPTVISIODT), Pan/Tilt remote control unit. 

e Panasonic (WV-5410), Video Monitor. 


In Ref. I Ayers describes the IRS 1D sidetectans. 


The IR detectors consist of two vertical arrays of sensing elements in the focal plane 
of the Schnudt telescope. The telescope 1s rotated so as to sweep the image across 
the detector arrays. Each array incorporates a column of 90 indium antimonide 
photovoltic linear detector elements. These two arrays are independent of each 
other and are covered by filters which pass selected wavebands of IR radiation in the 
3 to 5 micrometer range. Each element has the angular dimensions of 2 X .3 
miliradians with the larger being its height. Designated as the lead and the lag, 
these two arravs are separated by about one-half degree in azimuth. [Ref. 1: p. 17] 


Thus, as the IRSTD scans the horizon the resulting IR image has a resolution of ap- 
proximately 10-4 radians (0.00573°) in the horizontal plane and 0.23° in the vertical 
plane. The video svstem’s smaller field of view can be remotely controlled using the 
control units listed above. Thus, for the video data to be of any use in the development 
of the signal processing algorithms, the camera’s orientation must first be known, and, 
in order to determine the pixel-to-pixel correlation between the IR image and the video 
image, the position of the video camera needs to be known with the same kind of accu- 
racy as the IR image. The design and implementation of a position measuring system 


for this remotely controlled video camera is the subject of this thesis. 


B. DESIGN SPECIFICATIONS 
The design specifications for this problem were relatively straight forward. The po- 


sition measuring system needed to meet the following criteria. 
e The system should be able to measure the elevation angle (tilt), above and below 
the horizontal reference plane of the camera over a range of + 12°. 
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e¢ The measured elevation angle should be accurate to within + 0.23 


The svstem should be able to measure the bearing (pan), left or right of some ar- 
bitrary reference, of the camera over a range of 360°. 


The measured bearing should be accurate to within + 10-4 radians. 


The output should be displayed in a convenient form. The display should be 
collocated with the camera servo remote controls, an indoor site approximately 200 
meters awav from the camera. 


Portions of the measuring system required to be collocated with the camera should 
be weatherproofed. 


The system must be reliable and should be simple to operate. 


II. DESIGN STRATEGY 


A. GENERAL 

A position measuring system, like any system, is a combination of devices intercon- 
nected to perform a certain function. The most basic position measuring system (see 
Figure 1) consists of only four such devices: a transducer, a signal conditioner, a display 
device and a power supply. More complicated position measuring systems include those 
designed to take a number of different measurements either simultaneously or consec- 
utively. Still more complex systems multiplex these various measurements over a single 
channel to some distant location where they can be processed and displayed. [Ref. 2: 
pp. 2-14] 

The design specifications for the camera position measurement system (subsequently 
referred to as the “measurement system’) required that two measurements, pan and tilt, 
be taken simultaneously and transmitted some distance to a remote display. Two sepa- 
rate transducers, capable of independent operation, were therefore required. In order for 
both the azimuth and the elevation to be displaved simultaneously two display devices 
were also required. 

Several pairs of RG-178 coaxial cable were available to transmit signals between the 
camera servo and the remote control site. Since the cable was available and it was de- 
sirable to reduce the system complexity, a decision was made not to multiplex the data 
over a single channel. Instead, each measurand would have a separate transducer, a 
dedicated signal processor and a unique display device. Position information for each 
axis would be transmitted over a dedicated channel. 

The physical locations of the transducers and the display devices were dictated by 
the design specifications; however, there was some flexibility in deciding where to locate 
the signal conditioner. Site selection was based on an attempt to maximize total system 
performance and simplicity while ensuring the maintainability and environmental integ- 
rity of the signal conditioner. The only advantage to locating the signal conditioner with 
the camera servo and the transducer would have been to limit the distance that the 
transducer’s output signal would have to be transmitted to the processor. On the other 
hand, separating the signal conditioner and the transducers would limut the distance over 
which the conditioned signal would have to be transmitted to the display device. The 


trade-off here was not clear cut and would probably depend on the specific hardware 
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Figure f. Basic Electronic Position Measuring System: From Ref. 2: p. 2 


used and the speed of rotation of the camera servo. There was one significant advan- 
tage, however, to collocating the display and the signal processor; since they would both 
be indoors, the need for weatherproofing the signal processor would be eliminated. 

Powcr was available at both ends of the system, there was therefore no requirement 
to have a common power supply for the entire system. One supply could be used to 
provide power to the two transducers, collocated with the camera servo, and a second 
supply could power the signal conditioner and the displays. 

A block diagram of the prototype measurement system is shown interconnected with 
the cainera positioning system in Figure 2. Once this basic system layout had been de- 
ternuned, proper selection of the actual hardware was necessary. The design criteria 
were the primary consideration in the initial stages of the hardware selection. Final se- 
lection of the specific components, however, involved balancing additional factors, such 


as availability and cost against the system requirements. 


TRANSOUCER 


(PAW) 





CAMERA 







POWER 





POSITIONING 





SUPPLY 






SERVO 





TRANSDUCER 


(TILT) 









SIGWAL DISPLAY 







CONDITIONER 
(TILT) 





(TILT) 
CAMERA 


POWER 


POSITIONING 


SUPPLY REMOTE 


CONTROL 


SIGNAL 





OISPLAY 
CONDITIONER 
(PAW) 


(PAWN) 





Figure 2. Camera Position Measuring System 


B. TRANSDUCERS 
I. General 

Since in practice most measurement svstems do not have the ability to respond 
directly to the measurand, transducers are used to convert one physical quantity (e.g., 
angular position) into another, more usable quantity or signal (e.g., an electrical signal) 
[Ref. 3: p. 1-4]. The transducer is therefore a vital part of any measurement system, and 
although none of the components of this system could have been chosen independently 
of the other elements, proper transducer selection appeared to be the key to meeting the 
design specifications. Thus, selection of a transducer was the next step in the design 
process. 

Using the selection guidelines given by Norton on pages 51-53 of Ref. 2 and the 
design criteria stated previously, several observations and decisions were made which 
significantly reduced the number of transducers considered feasible for use in the meas- 
urement system. The fact that the servo was capable of rotating the camera left or right, 
and up or down suggested that the transducer should be capable of detecting both in- 
creasing and decreasing angles on both axes. Additionally, since the servo was antic- 
ipated to rotate the camera through one 360° arc in the horizontal plane, the transducer 
used to measure this angle (subsequently referred to as the “pan transducer”) needed to 
have a comparable range capabilitv. The range requirement for the “tilt transducer” 
(used to measure the elevation angle) was much less restrictive. These factors, angular 
bidirectional capabilitv and full scale range, eliminated a great number of transducers 
from the list of candidates. 

The list was further narrowed by the accuracy requirements previously specified. 
Again the accuracy in the horizontal plane placed a much more severe limitation on the 
selection of a transducer than the accuracy requirements for the vertical plane. The 
following paragraphs in this section outline the logic used in the selection of the 


transducers. The factors considered in the selection process included the following; 
e The accuracy requirements given in the specifications. 
e The ease with which a specific transducer could be installed on the servo. 


e The ability to weatherproof the servo and the transducer once the transducer was 
installed. 


e The rotation speed of the camera about the servo axes. 


e The extent to which a particular transducer/mounting configuration would modify 
the measurand. 


e Cost effectiveness. 


e Availability. 
e Signal conditioning requirements. 
e The extent to which the selection of a particular transducer would simplify or 
complicate the modification or expansion of the measurement system. 
2. Transducer technologies 
Displacement transducer technologies fall into three very broad categories de- 
pending on whether they are capable of measuring linear or angular displacement, or 
both. Some technologies could be eliminated immediately since they were clearly not 
suited for measuring angular position. Strain gauge displacement transducers, inductive 
displacement transducers and vibrating-wire displacement transducers are examples of 
such devices. The following paragraphs briefly describe the different transducer tech- 
nologies which were investigated. Table 1 on page 18 summarizes the salient points of 
the discussion. [Ref. 2: pp. 90-117]. 
a. Reluctive Displacement Transducers 
The rotary variable differential transformer (RVDT), which operates by 
detecting a change in the reluctance between coils, offers excellent resolution, dynamic 
characteristics, linearity and life expectancy [Ref.3: p. (2-14)]. Figure 3 shows a sche- 
matic diagram and a simplified cross-section of an RVDT. The ferromagnetic, 
cardioid-shaped core is attached to a shaft as shown. As the shaft rotates, the inductive 
coupling between the primary and each of the secondary coils changes. When the cam 
is symmetric with respect to the two secondary coils, their output voltages are equal but 
Opposite in phase which results in a differential output voltage of zero. As the shaft 
rotates away from this “null” the differential output voltage varies as shown in 
Figure 4. The linear region of the curve is limited to the angles between + 40° of the 
reference. Thus, the RVDT could not be used on the Pan axis. It was however, initially 
considered as a candidate for the Tilt transducer. [Refs. 2: pp. 93-99, 3: 
pp. (9-10)-(9-13) and 4: p. 19] 
Another type of reluctive displacement transducer is manufactured by 
Farrand Controls. Their INDUCTOSYN rotary position transducers have accuracies 
to + 1.5 arc sec (=(4 x 10-*)°). Unfortunately, these devices are 11.89 inches in diameter, 
and mounting them on the camera servo would have been extremely difficult, if not 1m- 


possible. [Refs. 2: pp. 89-111, 5] 
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Figure 3. RVDT Schematic: From Ref. 2: p. 98. 


b. Capacitive Displacement Transducers 
Angular displacement can also be measured by coupling the rotating com- 
ponent to the shaft a of variable capacitor in the manner shown in Figure 5. Lenk de- 


scribes the operation of the capacitive displacement transducer quite succinctly. 


The capacitor ... consists of a metal plate that moves between two fixed metal plates 
as a shaft is rotated. The three plates, and the air between them, form a capacitor 
With a capacitance that varies 1n proportion to the degree to which the plates are 
meshed. When the plates are completely meshed, the capacitance 1s at its maximum. 
When the plates are completely unmeshed, the capacitance is at minimum. [Ref. 4: 


p. 18] 
Capacitive displacement transducers offer many of the advantages of reluc- 
tance displacement transducers. Thev have an effective range of about 300° which, while 
better than the RVDT’s range, is still not adequate for the pan axis (Ref. 4: p. 18]. Ad- 


ditionally they are more sensitive to changes in the ambient temperature. Since the 
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Figure 4. RVDT Output Characteristics: From Ref. 2: p. 95. 
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Figure 5. Capacitive Displacement Transducer: Ref. 4: p. IS. 


measurement system was being designed to be used outdoors, the use of a capacitive 
displacement transducer would have required the addition of a temperature compensator 
in the design. While possible, this would have increased the svstem complexity consid- 


erably. [Ref. 2: pp. 90-91] 


c. Potentiometric Displacement Transducers 

Another very common and relatively simple family of transducers operate 
by measuring the change in resistance caused by a change in the measurand. There are 
a wide variety of such devices available. The basic form of potentiometric angular dis- 
placement transducers uses a resistance element, formed into an arc, and a movable 
electrical contact that rotates about the axis of interest. By measuring the change in 
resistance that results from a change in position, one is able to determine the angular 
displacement. The resistive element is typically a wirewound element, the resolution of 
which is determined by the number of turns per unit length of the resistance element. 
The angular resolution can be increased by increasing the turn density (wires/degree) of 
the potentiometer. 

The practical limit for wire spacing on wirewound elements according to 
Ref. 6 is between 500 and 1000 turns per inch. From Figure 6 one can see that this 


limits the angular resolution for a single-turn device to 





Ax (in) 
A@(rad)= an Rin) (1) 
Therefore, 
0.002(1 
A@(rad)x2AX _ 2O0%in) (2) 


D D(in) 


To achieve the 10-* rad resolution, specified for the Pan axis, with a single turn 
potentiometer would therefore require a 20 in diameter potentiometer. Mounting a de- 
vice this large on the camera servo was simply not feasible. Potentiometers are, how- 
ever, available with multiple turns. Shaped in a helix fashion similar to that shown in 
Figure 7, the total length of the potentiometer can be increased, which in turn increases 
its resolution, without increasing the diameter of the device. 

Increasing the resolution of the potentiometer by increasing the turn density 
in any of the manners described above, however, increases the output impedance of the 


device, which leads to increasing nonlinearity between the measurand and the transducer 


‘a 


Figure 6. 





Geometry of an Angular Potentiometric Transducer 


Figure 7. Miultiturn Potentiometer: From Ref. 6: p. 218 


output. The nonlinear relationship can be seen by analyzing the circuit shown in 
Figure 8. In the diagram the following variable definitions apply: 

e e, = Input voltage, 

¢ e, = Output voltage, 

e R,= Total resistance of the potentiometer, 

wae — Vieter resistance, 

Sex, — | otal range of the potentiometer, and 


¢ x,= Actual displacement of the potentiometer. 


Assuming that R,is uniformly distributed over x,, analysis of the voltage divider circuit 


gives, 








Figure 8. Potentiometric Transducer: From Ref. 6: p. 219 


Thus, the ideal (1.e., linear ) relationship, 


. 
is 





Las 


© i 
eps (4) 
is true only when R, R,=0, and since R, # 0, and R,, # oo, the nonlinear relationship in 
(3) will always exist. Doebelin states that “for values of R,/R,,< 0.1 the position of 
maximum error occurs in the neighborhood of x,/x,= 0.67, and the maximum error 15 
approximately 15(R,/R,,) percent of full scale.” [Ref. 6: p. 218] Other potentiometne 
transducers, Which use a resistive element made of carbon film or a conducting plastic, 
are not subject to the same kind of resolution limitations as wirewound devices; however, 
they do have high output impedances and the corresponding nonlinearities described 
above. [Ref. 6: pp. 217-224] 

A high quality multiturn potentiometer used in conjunction with a high 
quality voltmeter offered one possible solution to the design problem. However, the 
nonlinearity of this arrangement was a significant disadvantage, and the primarv reason 


Why potentiometers were not used. 


14 


d. Encoders 

The angular displacement transducer, referred to in general as an angular 
encoder or shaft encoder, converts an angular displacement into a digital signal without 
the use of an analog-to-digital converter. In today’s increasingly digital world this can 
be a distinct advantage. 

There are three different transduction methods used in encoders. Magnetic 
encoders use a pattern made from magnetized and nonmagnetized segments and one or 
more magnetic sensors that register as either “1's” or “O’s” depending on the magnetic 
characteristics of the section that they are adjacent to. Brush-type encoders are simular, 
but the sections are made of conducting and nonconducting materials. The conductors 
are all tied to a common source and the “sensor” 1s one or more brushes connected to 
the output. When the brush is in contact with one of the conductors the output is 
“on” and when the brush is in contact with an insulator the output is “off”. Optical 
encoders (See Figure 9) use a pattern of opaque sections marked on an otherwise 
transparent disk. A light emitting diode (LED), or other light source, is placed on one 
side of the disk, and as the disk rotates a light sensor on the other side of the disk 
“sees” periods of dark and light which it converts into a digital signal. [Ref. 2: p. 106] 

Angular encoders are further categorized as either absolute encoders or in- 
cremental encoders. Absolute encoders, similar to the optical encoder shown in 
Figure 9, use a multitrack pattern on a code wheel to produce a unique coded output 
signal for each incremental change in the measurand. These wheels use a variety of 
codes, including binarv code, binary-coded decimal (BCD) and Grav code, to determine 
the shaft position. The resolution of an absolute shaft encoder is limited by the number 
of tracks on the disk and the tvpe of code used. A simple binary or Gray code encoder, 
which are more efficient than the BCD encoders, with N tracks has an optimum angular 


resolution of 





Ad=—— . (5) 


Thus, to achieve the desired resolution of 10-* radians on the Pan axis with an absolute 
encoder would require a code wheel with N > 16. Since the output from the encoder is 
unique for each position, these devices are not affected by power outages, and the re- 
quirements for a signal processor for such a device would be limited to a simple decoding 


circuit. These encoders can measure angles of up to 360° without ambiguity. 


Is 


Incremental encoders use a code wheel which has only one track. As the 
shaft of the incremental encoder rotates the output from the encoder is a series of 
equally spaced pulses. These pulses can then be used as an input signal to an up,down 
(U,D) counter of some sort. The output from the counter is an indication of the dis- 
placement of the axis from some predetermined reference. The resolution of an incre- 
mental encoder is a function of the number of pulses the code wheel generates per 


revolution and 1s given by; 


360° 


aS nx PPR (6) 


where PPR is the number of pulses per revolution of the code wheel, and n is the number 
of revolutions that the code wheel makes per revolution of the axis of interest. If the 
incremental shaft encoder was mounted on the shaft of interest (n= 1) at least 62,832 


PPR would be required to ensure a resolution of 10~ radians. 


Coded disk 


Light sensor 
assembly 


Sensing shaft 


Light source assembly 
Reading line 





Figure 9. Absolute Photoelectric Angular Encoder: (a) typical code disk; (b) en- 


coder elements. From Rel 2apae7s 


Shaft encoders currently range in price from less than $100.00 to several 
thousand dollars depending on their capabilities and the method of transduction used. 
Litton Encoder’s Model 60 absolute shaft encoder uses a natural binary code, has 15 


tracks (0.1917 mrad resolution) and is available “off the shelf” for approximately $3000. 


Other absolute encoders with comparable resolutions are available at similar prices. No 
incremental encoders were found which offered the same kind of resolution as Litton’s 
Model 60; however, because they are not limited to one revolution of the axis, the re- 
solution of an incremental encoder can be improved by a factor of n by causing its code 
wheel to rotate n times for every rotation of the axis of interest. Incremental encoders 
with 1024 PPR are available from a variety of manufacturers for about $100 each. 
Connecting such a device to the axis of interest via a gear train with a 50:1 ratio would 
theoretically result (from (6)) in a resolution of 0.1227 mrad. Incremental encoders do 
require more complex signal processing than absolute encoders, and they are affected 
by power shut-off. Additionally, unlike absolute encoders, any missed or erroneous 
count that occurs with an incremental encoder will cause a persistent error. [Ref. 7: 
p. 16] 

After considering the measurement system performance criteria and the ca- 
pabilities and limitations of the various transducers, the use of an incremental. optical! 
shaft encoder appeared to be the best selection for the transducer for each axis. This 
decision involved balancing the various advantages and disadvantages of the different 
transducers. The following list gives a summary of the kev considerations in this deci- 


SiON. 


e Small, lightweight, highly accurate and relatively inexpensive models were readily 
available. Being small and lightweight suggested that mounting and 
weatherproofing the transducers in the camera servo should not be too difficult. 


e Absolute encoders offer almost all of the advantages of the incremental encoders; 
they are not affected bv power outage, thev require less complex signal processing 
and one time counting errors do not persist. However, these features did not seem 
to justify the additional price of an absolute encoder. 


e Linearity and loading problems associated with the potentiometric displacement 
transducers were avoided. 


e Direct conversion of the measurand into a digital signal precluded the requirement 
for an A'D converter. (This would have been a disadvantage had the use of an 
analog signal conditioner been anticipated.) 


e Using two identical transducers, each capable of meeting the specifications for the 
pan axis, would reduce system complexity while still ensuring that the design spec- 
fications Were met. 


C. MOUNTING THE TRANSDUCER 
Once the decision to use an incremental optical shaft encoder was made, selection 


of a specific model remained. Before selection of an actual piece of hardware could be 


17 


Table 1. ANGULAR DISPLACEMENT TRANSDUCERS 
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done though, one additional practical consideration had to be made; where and how 


could a transducer be mounted in or on the servo in order to measure the position of the 
Pan and Tilt axes? 

The physical layout of the camera positioning servo made direct connection of any 
tvpe of transducer to the axes of interest virtually impossible without major modification 
of the servo itself. Major modification of the servo would have been expensive, time 
consunung and outside the scope of this thesis. It was not considered an option in this 
case. Measurement of the Pan and Tilt axes’ displacements was most readily accom- 
plished indirectly. Each axis of the servo is positioned by a separate dc motor via a gear 


train. By mounting the shaft encoder code wheels to the sprockets (items 42 and 43 in 


Figure 10) which are each attached to one of the worms, an indirect measurement of the 
position of each of the wormgears (items 5 and 7 in Figure 10) was possible. This ap- 
proach, made necessary by the servo design, was a mixed blessing. 

The backlash in a Worm-wormgear connection will cause the position of the worm 
to be different for any given wormgear position, depending on whether that position 1s 
approached from a clockwise or a counterclockwise direction. In order to correctly de- 
termine the displacement of the wormgear by measuring the displacement of the worm, 
the amount of backlash present must be known (i.e., would have to be determined ex- 
perimentallv) and accounted for by the measurement system. This nonlinear source of 
error would not have been a concern if the servo was only required to rotate in one di- 
rection. This was not the case, however, and hysteresis eventually was determined to 
be the lurgest single source of error in the measurement system. A more complete dis- 
cussion of this topic is included in Chapter IV of this thesis. 

Assuming for the moment that the effects of the backlash in the gears could have 
been completely compensated for, mounting the shaft encoders on the worm provided 
a measurement advantage analogous to the mechanical advantage afforded by the gear 
train. Initial measurements indicated that each of the worms turned through 18,000° 
(SO x 360°) for every 360° rotation of the corresponding wormgear. This meant that a 
shaft encoder with 100 divisions per 360° attached to the worm axis could do the same 


job as a 5,000 division per 360° encoder attached to the wormgear axis. 


D. SELECTING AN OPTICAL SHAFT ENCODER 

Once the basic decisions to use incremental optical shaft encoders and to mount the 
encoders on the worms inside the servo housing had been made, selection of the specific 
pieces of hardware was relatively straight forward and was primarily a matter of con- 
Memience and expediency. 

Returning to the design specifications for a moment; the most stringent requirement 
was to be able to measure the position of the pan axis to within + (5.73 x 10-3)°. To 
determine the required resolution for the optical shaft encoder, the following calculations 
were performed. 


First, 


360°/Revolution ot 
— ~62,827 Wawisiens 
5.73 x 10 ~°/Division Revolution 


(7) 
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Figure 10. Camera Servo: From Ref. 8: p. 12. 


Then, considering the 50:1 gear advantage, 


62.827 Divisions 
50 a cal Revolution — (8) 


The task therefore was to find an optical shaft encoder capable of detecting 
bidirectional rotation with at least 1257 Divisions/Revolution in a package small enough 
to mount in the servo housing on the worm axis. There was no absolute size limitation; 
however, due to the construction of the servo it was desirable to find an encoder that 
was no more than 3 in. in diameter and no more than 1.5 in. in width. The companies 
that make shaft encoders are capable of custom building devices to meet a customer’s 
specific needs. However, the prices are high, and the lead times are long for these special 
order parts. The encoder for this system needed to be reasonably priced and readily 
available to ensure timely completion of the project and to facilitate replacement, if 
necessary, in the future. 

Optical shaft encoders are manufactured by numerous companies including Litton, 
Honeywell, BEI, IVO and Hewlett Packard. Sales literature from these companies was 
reviewed prior to making a decision on the specific shaft encoder model to be used. In- 
cremental optical shaft encoders with resolutions that range from one pulse per revo- 
Jution (PPR) to 2540 PPR are available off the shelf from one or more of these 
companies. While evaluating sources of supply, incremental optical shaft encoders were 
also found in use in various laboratories and shops in the Electrical Engineering and 
Physics Departments at the NPS. Encoders immediately available from stock included 
two Vernitech 1200 PPR (model VOE-23-1200-AI-LD5-2L1-1603-2) encoders from the 
Physics Department and two Hewlett Packard (HEDS-6000,J06) encoders from the 
Electrical Engineering Department. The use of the Vernitech encoders was ruled out 
because they were unable to detect bidirectional movement without increasing the com- 
plexity of the signal conditioning subsystem. Additionally, technical literature requested 
on two separate occasions from Vernitech was never received. 

The HEDS-6000,J06 encoders have a resolution of 1024 PPR. Each encoder pro- 
vides displacement information in the form of TTL logic level signals via two output 
channels. When the encoder is properly adjusted the two output signals have a 90° 
phase difference. This quadrature phase relationship permits these encoders to detect 


bidirectional displacements. Rotation in one direction will cause Channel A to lead 


Channel B (in phase), while rotation in the other direction will cause Channel B to lead 
Channel As (Ret so) 

The presence of two output channels in quadrature phase has an additional benefit 
that 1s useful in some applications. Since the amount of position information has es- 
sentially been doubled, if the signal conditioner is designed to detect both the leading and 
trailing edges of one of the output channels the resolution of the measurement system 
can be doubled. The difficulty with using this technique is that multiple oscillations 
about a single point cannot be detected as such. If the camera were to oscillate less than 
one half of a pulse width about a transition the signal conditioner would detect and er- 
roneously count the multiple transitions. [Ref. 7: pp. 13-16] 

With 1024 PPR, which is less than the 1257 PPR required to meet the 0.1 milliradian 
accuracy specification on the pan axis, the maximum resolution available, if the 


HEDS-6000 was attached to the worm, can be calculated as; 


360° 


Tb x 1oaay 7 (7203125 x 107°)? Pulse™? . (9) 


Although this was not sufficient to satisfy the pan axis resolution specification of 
(5.73 x 1073)°Pulse,-! all of the other performance criteria could be satisfied. The trade- 
off seemed reasonable and was approved prior to proceeding further with the system 


design. 


E. THE DISPLAY 

Selecting a method to display the final svstem output was certainly the least de- 
manding task required in the design of the system. With an expected resolution on the 
pan axis of approximately 0.007° over a range of 360° (a ratio of about 1:51,500) an 
analog displav seemed out of the question. A five or six digit digital display on the other 
hand offered a simple, reliable and cost efficient means of presenting the output. Con- 
structing the displays from individual, seven-segment, common anode, LED devices, and 


the appropriate display drivers was a straight forward task. 


F. THE SIGNAL CONDITIONER 

Anticipating the use of two incremental shaft encoders as the transducers for the 
measurement system and the use of digital readouts as the displav devices significantly 
reduced the number of possibilities for the signal conditioning subsystem. In addition 


to the hardware and software described in each of the subsequent discussions, each 


technique listed here would require an edge detector to detect the transitions in the TTL 
signals from the shaft encoders. 

e Up/down counter with table look-up. 

e Up,down counter and multiplication. 

e Add/’subtract. 

e Microcomputer. 


e Microprocessor. 


1. Up/down (U/D) counter with table look-up 

This technique would involve the use of a shift register, some associated logic, 
an U/D counter and a table look-up device such as an erasable programmable read only 
memory (EPROM). The shift register would serve as a hardware buffer that could be 
used to account for the hysteresis introduced by the worm-wormgear assembly. The 
length of the buffer would have to be determined experimentally. The logic associated 
with the shift register would determine the “validity” of each transition (count) signal 
from the edge detector by checking the contents of the shift register and comparing the 
current direction of rotation with the previous direction of rotation. Whenever the logic 
detected a change in rotation direction, or a partially full, or a partially empty buffer 
(depending on the direction of rotation), the transition would not represent a “valid” 
count since any of these conditions would indicate that the transition was due to a 
change in the position of the worm without a corresponding change in the position of 
the wormgear. Thus, the present transition would be the result of hvsteresis due to the 
backlash in the gear train and the transition would be “invalid”. Such a transition would 
cause the contents of the hysteresis buffer to be modified appropriately. A more com- 
plete discussion of this topic is contained in Chapter IV. The shift register and associ- 
ated logic could be built from common TTL devices readily available at the NPS. 

Once a count had been determined to be valid, an UD counter would be used 
to keep a running total of the number of counts. Again, such a device could be built 
using readily available TTL devices such as the 74LS168A, Synchronous 4-Bit Up, Down 
Decade Counter, or the 74LS169A, Svnchronous 4-Bit Up/Down Binarv Counter. The 
output from the U,;D counter would then be used as an address to “look up” a prede- 
termined number stored in an EPROM. 

This design approach was considered relatively straightforward, and at least in- 
itially seemed like a viable option. Its major advantage was that it was conceptually 


quite simple. This simplicity had a price though; it would have been very hardware in- 


tensive and consequently would have been a very inflexible design. For example, if at a 
later date the use of an arbitrary reference was desired, additional hardware would have 
to be added to the signal conditioner so that the counter could be initialized to the ar- 
bitrary starting point. Since all of the processing would have to be done in hardware, 
even a minor modification in the system could necessitate a major design revision. An- 
other consideration was that saving in excess of 51,000 unique positions in the EPROM 
presented a nontrivial problem that would need to be solved if this technique was used. 
2. Up/down counter and multiplication 

This 1s very similar to the previous case, differing only in that instead of looking 
up a predetermined position, in a memory device, a multiplier would be used to multiply 
the output of the U,D counter by a predetermined constant. As an example, if exper- 
imental results indicated that the shaft encoders generated one pulse for every 
0.00703125° that the camera was displaced, then each time a valid count was received, 
the updated count would need to be multiplied by 0.00703125 in the final stage of the 
signal processor. The result would be the new position. Again, while conceptually 
simple this idea had some significant disadvantages. Even more hardware intensive than 
the first approach, this design would also have extremelv limited flexibility. 

Accomplishing the multiplication would have posed a formidable task. The 
scale factor would have to be written as some integer (e.g., 0.00703125 would become 
703125, or 70323, or 7031, etc.) depending on the desired accuracy. The count, already 
an integer, would be multiplied by the constant and the correct position of the decimal 
point would have to be determined. Locating the decimal point would be a relatively 
simple task, but multiplication of two numbers such as 51,000 and 70,313 would not be 
as easy. At least one 16 bit by 16 bit binary multiplier (1.e., TRW’s MPYO16H) ts cur- 
rently available, but since the number 70313 cannot be represented in binarv by less than 
17 bits, the multiplication could have been accomplished in either of two ways. One 
solution would have been to perform the multiplication in two or more stages. Alter- 
natively, 70313 could be “rounded” to 7031. The second option would create a cumu- 
lative round-off of about (1.28 x 10-3)” per 360° rotation (assuming 51,200 pulses per 
360° ). This round-off error would probably have been acceptable, but the complexity 
and limited flexibility of either multiplication scheme made the U’/D counter and multi- 
plication an unacceptable candidate for the signal processing subsystem. 

3. Add/subtract 
A third design concept considered the elimination of the U/D counter alto- 


gether. The same logic proposed for use in the previous two designs could have been 


used to check the validity of a count and to determine the direction of rotation. How- 
ever, instead of valid counts being sent to an U/D counter as before, these counts would 
now signal an adder to add or subtract a predetermined constant from the running total. 
Just as before, this simple idea could probably have been made to work at least once, 
but its usefulness as a part of a larger system would certainly have been limited. The 
large number of components required to realize this design would have increased the 
probability of failure, complicated troubleshooting and reduced overall flexibility. 
4. Microcomputer 

If the signal processing subsystem was built around a microcomputer (PC), vir- 
tually all of the disadvantages associated with the previously discussed approaches would 
be eliminated. Since all of the logic could be implemented in software, modifications to 
the system would be relatively simple to make, and the system's flexibility would be en- 
hanced. However, dedicating a microcomputer, even an inexpensive model, to the signal 
processing tasks for this measurement system was considered overkill, and timesharing 
with one of the PC’s already in service was possible, but not considered practical or 
convenient since these microcomputers had already been dedicated to a variety of tasks. 

5. Microprocessor 

One final option for the signal processor remained. Microprocessors are rela- 
tively inexpensive and powerful and are available in a wide variety of makes and models. 
If a microprocessor was used instead of a microcomputer or a straight hardware 
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processor, the “nice to have” requirements such as flexibility, ease of modification and 
capacity for expansion, as Well as the required signal processing functions could all be 
satisfied. On the other hand, microprocessors have one distinct disadvantage; they are 
not user friendly. The use of a microprocessor implied countless hours spent tracking 
individual bits, debugging assembly language code, studying timing diagrams, etc.. No 
matter how distasteful the thought, however, a microprocessor was clearly the best way 
to perform the signal processing functions of the measurement system. 

As with the selection of the transducer, once the basic design approach had been 
determined, selection of a specific device was a relatively straight forward task. The 
choice of one microprocessor over another was a function of the processor’s ability to 
perform the required tasks, cost effectiveness and availability. Motorola’s MC68705U3 
seemed to satisfv all of these requirements. The MC68705U3 is a four kilobyte EPROM 
microprocessor, built using HMOS (high-density NMOS) technology with an eight bit 
architecture. The “68705” operates on a 5.0 volt de supplv, has 112 bytes of on chip 
RAM, four vectored interrupts, 24 TTL’CMOS compatible bidirectional IO lines (eight 
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lines are LED compatible), eight dedicated input lines and an internal eight bit tmer 
with a seven bit programmable prescaler. [Ref. 10: p. 1] 
In Ref. 10 Motorola advertises the following software features: 


e Programming language similar to the 6800 family. 
e Byte efficient instruction set. 

e Easy to program. 

e True bit manipulation. 

e Bit test and branch instructions. 

e Versatile interrupt handling. 

e Powerful indexed addressing for tables. 

e Versatile index register. 

e A full set of conditional branches. 

e Memory usable as registers; flags. 

e Single instruction memorv examine/change capability. 
e Ten powerful addressing modes. 


e All addressing modes apply to EPROM, RAM and I, O. 


One key advantage to using the MC6$705U3 was that one of the micro- 
processors, and a Motorola M6870SEVM (the evaluation, programming module for the 
M6805 family of devices) were both available for immediate use at the NPS. The fact 
that the 68705 utilized HMOS technology suggested that it should be a relatively low 
cost microprocessor. In fact, except for the price of a phone call, a second micro- 
processor was obtained free of charge from a local electronics wholesaler. Additional 
microprocessors, to be used as replacements and as backup devices were ordered for 
about $20.00 each. 

One potential problem with using a microprocessor begged checking prior to 
proceeding. Initial measurements of the camera’s maximum rotation Velocity produced 


the following results. 
© pan (max) ~ 1.0 rpm (10) 
© r1LT (max) = 9.5 rpm (11) 


Again the requirements for the pan axis presented the most stringent design limitations. 


Since the optical shaft encoders were anticipated to deliver 51,200 PPR ( 1024 x 50) the 


microprocessor on the pan axis had to be capable of processing 51,200 pulses’minute 
(1.172 ms / pulse). The MC68705U3 is designed to operate with an oscillator frequency 
(f,,.) of between 0.4 MHz and 4.4 MHz and has an instruction cycle time (4/f,..) of be- 
tween 0.950 us and 10 ws. Assuming that a 4.0 MHz clock was used, the instruction 
cycle time would be 1.0 us. This would mean that the processing of each pulse would 
have to be accomplished in no more than 1172 instruction cycles to ensure that no pulses 


would be missed. 


Ii. DESIGN 


A. GENERAL 

The schematic diagrams for the measurement system are shown in Appendix A; 
Appendix B contains copies of the printed circuit board plans. Before describing the 
detailed operation of each of the individual components of the measurement system, a 
brief overview of its basic theory of operation is in order. The measurement system is 
actually two separate systems Operating independently. The system designed to measure 
the azimuth or pan angle will subsequently be referred to as the “Pan Svstem”, and the 
other svstem, designed to measure the elevation or tlt angle, will be referred to as the 
“Tilt System’. However, because the two systems are quite similar the discussion which 
follows will only specifically describe the operation of both systems where their opera- 
tion differs. 

In the most general terms, the measurement system shown in Figure 2 on page 6 
uses two microprocessors to count the pulses generated by the incremental shaft encod- 
ers, and to provide output signals to the display devices. The counting function per- 
formed by each microprocessor involves determining the direction of rotation and 
determining whether each count is “valid”. Valid counts are encoder pulses which result 
from the displacement of the camera servo, while invalid counts are a result of the 
hysteresis in the gear train. The number of valid counts 1s directly proportional to the 
angular displacement of the camera axis. 

Both of the displays are capable of presenting the position information 1n two basic 
forms. In the Count Mode they display the number of pulses that have been detected, 
and in the Position Mode thev display the angle in degrees that the number of pulses 
represents. A third display mode, which is a combination of the first two, 1s also avail- 
able. In the third mode, referred to as the “Blinking Mode”, the display will alternately 


display the count and the angle. 


B. SHAFT ENCODER AND LINE DRIVER 

Figure 11 shows the basic components of the HEDS-6000 incremental optical shaft 
encoder. The encoder is approximately 56 mm in diameter and 20 mm deep. The code 
wheel assemblies for the HEDS-6000 JO6 encoders are designed to mount on 0.25 in. 
shafts. Since the mounting surface shown in Figure 11 is not part of the encoder kit, 


and did not existed on either of the worm axes, two such surfaces were machined in the 


Physics Department Shop and attached to one end of each of the worms. Each surface 
has a 0.25 in. diameter shaft to which one of the code wheel assemblies 1s attached. Two 
sheet metal brackets, also made in the Physics Department Shop, are bolted to the servo 
frame. The encoder bodies are mounted to these brackets. Figure 12 shows the shaft 


encoders mounted in the camera servo. [Ref. 9: p.1] 


EMITTER CODE WHEEL PHASE ENCODER MOUNTING 
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Figure 11. HEDS-6000 Series Encoder Kit: From Ref 9: p.6. 


Also seen in Figure 12 1s a printed circuit board mounted between the two optical 
Shaft encoders. Each of the encoders is electrically connected to the board via a separate 
ten wire ribbon cable. The power and the output signals from the shaft encoders are 
transmutted through these cables. A sketch of the ribbon cable connector and the pinout 
for the connector are shown in Figure 13. Each connector is attached to a ten pin 
header on the printed circuit board. Pins 2, 7 and 9 are connected toa + 5.0 Vdc power 
supply external to the camera servo. A description of the power supplv is given later in 
this chapter. Pins 3, 4, 5 and 6 are connected to the power supply ground. The 
FHIEDS-6000 does not have an index pulse, therefore pin 10 is not connected. 

The remaining two pins on each header connect the output channels of the shaft 
encoders to two 74S140 line drivers. Each 748140 is a dual four-input NAND gate 
50-Ohm line driver. The line drivers are powered by the same supply as the encoders. 
They serve as buffers between the encoders and the transmission lines which are used to 


transmit the encoder signals to the signal conditioner. The line drivers’ typical high 
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Figure 12. Modified Camera Servo: (a) Optical shaft encoder used to measure 
Pan axis displacement, (b) Optical shaft encoder used to measure Tilt 


axis displacement, (c) Ribbon cable, (d) Printed circuit board. 


output current is 10 mA and the maximum is 18 mA. Resistance in the transmission 
line was measured to be approximately 35 22, and to be on the safe side a 10 Q con- 
nector loss was assumed. The voltage drop due to an 18 mA current through a 45 Q 
resistance is 0.81 V. A “voltage high” signal received at the signal conditioner should 
therefore be about 4.19 V. This is well above the maximum, positive-going threshold 
voltage specification of 2.0 V for the 7414 Schmitt triggers, which are used to receive the 


signals at the signal processor. [Ref. 11: pp. 5-73, 5-74, 6-44] 


C. ENCODER-MICROPROCESSOR INTERFACE 

The signals transmitted by the two line drivers are Channels A and B of each of the 
shaft encoders. These signals contain the raw data which the signal processor converts 
into position information. Three pairs of multiple pin connectors are used in the 


encoder-microprocessor interface. The pinouts for these connectors are shown in 
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Figure 13. Encoder Connector Specifications: From Ref. 9: p. 6. 


Figure 14. Each of the four signals is received at the signal processor by a 7414 Schmutt 
trigger which is used to “clean up” the signal. The Schmitt triggers lower the svstem’s 
Susceptibility to errors caused by slow state transitions and increase the signals’ fan out 
capabilities (Ref. 7: p. 13). . 

The output of each Schmitt trigger 1s routed to an input port of the appropriate 
microprocessor. Each Channel A signal is also the input to an edge detector. The edge 
detectors each consist of three 7414 inverters. a 74LS86 EXOR gate and a 47 nF 
capacitor, configured in the manner shown in Figure 15. This configuration causes the 
interrupt line to go low for approximately 2 us each time Channel A transitions from 
of 4.0 MHz 1s being 


used, the interrupt pulse width, ty,, must be greater than or equal to 1.25 ws [Ref. 10: 


low to high or from high to low. Since an oscillator frequency, f,,., 
p. 3]. The value of the capacitor required to achieve the 2 us delay was determined ex- 


perimentally. 


D. SWITCHES 

The measurement system has 10 switches that allow the operator to control specific 
functions of the signal processors and the displays. Figure 16 shows the physical lo- 
cation of these switches on the control panel. Switches SW1(P) and SW1(T) control the 
reset lines to the microprocessors. Switches SW2(P), SW2(T) and SW5 control the dis- 
play mode. The Function and Set switches; (SW3(P), SW3(T), SW4(P) and SW4(T)) 


allow the user to change the length of the hysteresis buffer in the microprocessor. The 
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Encoder-Mlicroprocessor Connector Specifications 


Figure 14. 
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MICROPROCESSOR 
1/6 74LS14 
INTERRUPT 


1/0 PORT 


1/6 74LS14 





Figure 15. Interrupt Interface: After Ref 7: p. 14. 


master power switch is SW6. Table 2 identifies the switches by name, description and 
function. 

Any mechanical switch will “bounce” or “chatter” when it is thrown, and since the 
operation of the signal processor depends on the nuinber of times that the Display Mode 
and Set switches change position, these switches had to be “debounced”. A very simple 
but effective way to do this is with an RS latch. Switches SW2(P), SW2(T), SW4(P) and 
SW4(T) are each debounced in this manner. Each latch is made from two 74S00 NAND 


gates connected in the manner shown in Figure 17. [Refs. 13: pp. 132-135, 12: pp. 3,4] 


SW 5 e LIGHT TEST 


2 as 


SW 1 


DISPLAY MODE SW 2 


FUNCTION (HYSTERESIS) SW 3 


SET (HYSTERESIS) SW 4 


Figure 16. Contro! Panel 


E. MC68705U3 

1. General 
The two 40 pin MC68705U3 microprocessors (MPU’s) are the heart of the 
measurement system. With the exception of the light test signal, every signal in the 
svstem is either part of the input to one of the MPL 's or part of their OuIpRieaae 
MPU’s were programmed using the assembly language syntax, assembler directives and 
instruction set for the M6SOS family of microprocessors which are described in Ref. 14. 
The Pan and Tilt programs are hsted and their operation is described in Appendix D. 
The pin assignments for the MC68705U3 are shown in Figure 18. Table 3 briefly de- 


scribes the purpose of each pin and the actual connections for the two MPU’s. 





Debounced 
output —” 





Figure 17. Debouncing circuit: After Ref 12: p. 4. 


2. Memory Map 
a. Input{/ Output (1/0) 

The memory map for the MC68705U3 is shown in Figure 19. The digits 
following a “S” are the hexadecimal representation of the address for a specific memory 
location. The data registers occupy the first four memory locations ofeach MPU. Thus 
the information written into the registers at S000, S001 and S002 is written to the output 
ports A, B and C respectively. Port D, at address $003, is an input only port as indicated 
in Table 3. In order to determine the state of the input lines, the contents of the register 
at $003 must be read by the MPU. Registers $004, S005 and S006 are the data direction 
registers (DDR’s) for Ports A, B and C respectively. Because all three ports are used as 
“output only” ports, in this application, the DDR’s are all established as such by an 
initialization routine performed by the MPU’s during their initial power-up and after 
GmemeXternal reset. (Ref. 10: pp. 5, 12, 14] 

Pin 18 of the MPU can be used as either a general purpose input line or as 
an interrupt line. The primary interrupt line on each MPU 1s used to signal the occur- 
rence of a state transition on Channel A. Pin 18 is used as a second interrupt line to 
signal a display mode change request from the operator. The Miscellaneous Register 
(MR) at address SOA is used to control the operation of the second interrupt line 
(NT?) . In order to establish pin 18 as an interrupt line, bit 6 of the MR 1s cleared by 
the Initialization Routine. The INT2 Interrupt Request Bit, bit 7 of the MR, is cleared 
by default upon reset. It is set when a falling edge is detected on the Display Mode line 
Which is connected to pin 18. When this occurs and bit 6 of the MR is cleared, an in- 


lerrupt request 1s generated. This interrupt request causes the display mode to change. 
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Table 2. SIGNAL PROCESSOR AND DISPLAY SWITCHES 


New DESCRIPTION AND FUNCTION 


PAN RESET Momentary action push button switch: Resets the Pan 


(SW1(P)) Microprocessor. Causes the Pan Display to be reset to 
zero. 


THRPRESEd| Same as SWI(P) except it affects the Tilt System only. 
(SWI(T)) 


PAN DISPLAY MODE jj Single pole double throw toggle switch: Each tume the 
(SW2(P)) switch position 1s changed the Pan Display toggles from 





Count mode, to Position Mode, to Blinking Mode, to 
Count Mode, etc.. 


TILT DISPLAY MODE | Same as SW2(P) except it affects the Tilt Display only. 
(SW2(T)) 
















FUNCTION 
(HYSTERESIS) 
(SW3(P)) 







Single pole double throw switch: When closed, causes 
the “Function” line of the Pan Microprocessor to go 
low and causes the size of the hysteresis buffer to be 
displayed on the Pan Display. Enables SW4(P). 











ELaN GLOGS 
(Ely > | ERESIS) 
(SW3(T)) 


SEL YS LER Eis 
(SW4(P)) 


Same as SW3(P) except it affects the Tilt System only. 











Single pole double throw switch: Inoperable unless 
SW3(P) is closed. If SW3(P) is closed, each time the 
position of SW4(P) is changed the length of the 
hysteresis buffer is incremented by one. Maximum 
buffer length is 25. Toggling SW4(P) when the buffer 
length 1s 25 will cause the buffer length to be resemms 
Zenon 


SET ESSER ESIS Same as SW4(P) except it affects the Tilt Hysteresis 
(SW4(T)) buffer. 


bIGridaiieSi Single pole single throw switch: When closed, lines ], 
(SW35) 2, 7, 8, 10, 11 and 13 on each of the LED displays will 
go low. Unless an element is burned out, every digit in 
both displavs should be an eight. 










POWER Single pole single throw switch: When closed, applies 
(SW) + 5.0 V de power to the signal processors and the dis- 
plavs. 
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Figure 18. MC68705U3 Pin assignments: From Ref. 10: p. I. 


Once bit 7 has been set by an interrupt, it must be cleared by software to avoid repeated 
and unwanted interrupts from occurring. This task is performed by the Mode Change 
femme in each EPROM. [Ref. 10: pp. 1, 10, 13, 15] 
b. Timer 

The operator can cause either or both of the displays to “blink” by using 
the Display Mode Switches, SW2(P) and SW2(T). When one of the systems has its 
display in the Blinking Mode, the associated MPL uses its timer to generate a timer in- 
terrupt request every second. The interrupt request causes the MPL to execute the 
Mode Change Routine. A block diagram of the timer is shown 1n Figure 20. The timer 
consists of an eight-bit counter which is decremented toward zero by the fo), input. 
When the counter reaches Zero, it sets the Timer Interrupt Request Bit (TIR) of the 


Timer Control Register (TCR), and a timer interrupt request is generated unless the 


of 
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Figure 19. NIC68705U3 Memory Configuration: From Ref. 10: p. 5. 


Timer Interrupt Mask Bit (11M) of the TCR ts set. A brief description of cach of the 
timer registers and their configuration follows. 

(1) Timer Data Register (1DR). ‘the TDR ts the cight-bit counter 
which sets the TIR bit of the TCR when it decrements to zero. 

(2) Timer Control Register. The contents of the ICR determine the 
general operation of the timer. 


e Bit 7, Timer Interrupt Request (THR), stgnals a TDR underflow when it is set and 
will cause a timer interrupt request if the TIM bit of the TCR is clear. The TR 
is cleared by the MPU reset or by program control. 


¢ Bit 6, Timer Interrupt Mask (11M), inhibits a tiner interrupt request When it 1s set. 
It is set by external reset or program control to inhibit the Blinking Mode, and 1s 
cleared by software when the Blinking Mode is requested by the operator. 


e Bit 5, External or Internal Clock Select (TIN), is used to select the timer clock 
source. Since the internal clock is used in this application, the TIN bits of both 
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Table 3. MPU CONNECTIONS 


Namie Description 


ee 


When RESET is pulled low program execution halts, all variables are 
reinitialized and the Pan display is set to zero. SW1(P) controls the 
Reo ine Onthe ran vie. 


Allows asynchronous interruption of the processor. When INT is 
pulled low by the Count Edge Detector the MPU executes the 
one IOuLine 












EXTAL| External clock input. Connected to a 4.0 MHz external clock which 
Enotes the MEU svstem clock. 












Timer | External timer control input. Connected to V¢,_ since the internal 
timer 1s used. 


me | Port C | General Purpose I’O lines. 


9 | PCO The two least significant digits in the display are represented in bi- 
nary coded decimal (BCD) by these eight lines. 
(ea ee 


RD] rads the Channel A input to the MPU. 


a pps | PDO is used as a second interrupt line. 
INT2 


When PD6 goes low the MPU changes display modes. 
mei Pps 


PDS is the Channel B input into the MPU. 
PD4 is the Function input into the MPU. 


PD3 is the Set input into the MPU. 


PD2-PD0 are not used and are tied to ground. 
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Table 4. MPU CONNECTIONS (CONTD.) 
| | Port B_| General Purpose I’O lines (LED compatible). 


The most significant digit is represented in BCD by PBO-PB3 except 
ares | on the Tilt MPU where these lines are connected to ground. 


PB4 determines which digits in the display are blanked. 


PBS is not used. Connected to ground. 


PB6 determines the presence or absence of the display minus sign. 
PB7 determines the presence or absence of the display decimal point. 


|__| Port A | General Purpose LO lines, 
chee ite cunts least significant digits are represented in BCD 
¥ these eight lines. 





MPU’s are always cleared. For the same reason the Timer pins are connected to 
Meee see Udine aes 


Bit 4, External Enable (TEE). is not used by the measureinent svstem. By keeping 
the TEE clear at all times, the 68705’s internal timer is used exclusively. 


Bit 3, Prescaler Clear (PSC), is not used in this application; always cleared. 


Bits 2-0, Prescaler Select (PS2, PS1 and PSO), are alwavs set during program exe- 
cution. This causes the internal timer signal frequency to be divided by 128. 


(3) Mask Option Register (MOR). Unlike the TDR and TCR the MOR 


is not software programmable; instead, it is implemented in EPROM. 


Bit 7, the Clock bit, is cleared to allow operation of the external 4.0 MHz clock. 


The Timer Option bit (TOPT), bit 6, 1s also cleared in this application. This per- 
mits the TCR to be software programmable. 


Bit 5 1s cleared to permit the use of the internal clock with the timer. 


Bits 4 and 3 are not used. 
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Figure 20. 


e Bits 2-0 are all set and serve the same function as PS2, PS] and PSO bits of the 
TCR. [Ref. lOmpps628e813=15) 
3. RAM 

The MC68705U3 has 112 bytes of RAM. The 112 bytes includes 31 bytes that 
can be used for the stack. Use of the stack is quite limited. During interrupts it is used 
to save the contents of the CPU registers and the program counter. During subroutine 
calls only the program counter is saved. The user’s program has no other access to the 
stack. The programs written for each of the MPU’s require less than 25% of the avail- 
able RAM. The Pan MPU uses 27 of the 112 available bytes and the Tilt MPU uses 
only 22 bytes. The programs listed in Appendix D explain the function and give the 
location in memory for each of the variables. [Ref 10: p. 5] 

4. ROM 

The 3776 bytes of user EPROM in the MC68705U3 are divided into three sep- 
arate blocks in the memory. Page Zero User EPROM 1s the ROM located between ad- 
dress SOSO and SOFF. Because these addresses are onlv one byte long, instructions 
located in Page Zero ROM can be referenced with addressing modes not permitted with 
instructions located in other parts of the memory. Between address $100 and SF37 1s the 
User Main EPROM. This portion of the memory in each MPU contains the vast ma- 
jority of the signal conditioning programs. Located in another portion of the EPROM 
are the Interrupt Vectors. In each of these locations is the address of the first instruction 
the MPU is to execute when a particular interrupt occurs. 

As with the RAM only a fraction of the available EPROM has been used in this 
application. The Pan MPU uses 899 bytes of the 3776 available and the Tilt MPU uses 
onlv 767 bytes. Since both programs are so small. one could reasonably ask why the two 
programs were not both put in one MPU. The primarv problem with this idea 1s that 
each microprocessor can perform onlv one operation at a time. As indicated at the end 
of Chapter II, if the camera servo is rotating about its vertical axis at 1ts maximum ve- 
locity of | rpm, the Pan signal conditioner must be capable of counting and displaying 
51,200 counts per minute. Using a 4.0 MHz clock this allows the MPU 1172us to count 
each pulse. Similarly the Tilt MPU has !758us to count each pulse when the camera 1s 
rotating at 1ts maximum Velocity about the horizontal axis. Assuming that the camera 
is rotating at its Maximum Velocity on both axes at the same time, and one MPU is being 
used to count the pulses from both encoders, the MPU needs to count 76,800 pulses per 


minute, which only allows 781.3 us per pulse. The Pan MPU currently requires a max- 


imum of 1032 instruction cycles or 1032us to count a single pulse, and the maximum 
execution time for a single pulse on the Tilt axis 1s 825us. Thus, a single 68705 lacks the 
computational speed required to ensure that no counts would be missed if it was used 
to process the data from both encoders. 

5. Central Processing Unit (CPU) 


The CPU of the M6805 Family is implemented independently from the I/O or 
memory configuration. Consequently it can be treated as an independent central 
processor communicating with I/O and memory via internal address, data and con- 
trol buses. [Ref 10: p. 6] 


The CPU has five registers that are available for use by the operator. The 


function of each of these 1s described below. 


¢ The Accumulator (A) is a general purpose data register used for arithmetic calcu- 
lation and data manipulation. 


e The Index Register (X) can be used as a second accumulator but is generallv used 
for the indexed addressing mode. In the indexed addressing mode an effective ad- 
dress 1s created by adding the contents of X to a number provided bv the instruc- 
tion. 


e The Program Counter (PC) contains the memory address of the next instruction to 
Berexecuted by the MPL. : 


e The five bits of the Condition Code Register (CCR) keep information concerning 
the results of the last instruction executed by the MPU. Reference 14 gives a de- 
tailed description of each of the instructions in the M6805 Family Instruction Set 
and explains the effect of each instruction on the CCR. A brief description of each 
bit in the CCR follows. 


» The Carrv (C) bit is set if a carry or a borrow was generated by the last arith- 
metic instruction. The state of the C bit can be software controlled. 


« The Zero (Z) bit is set if the result of the last arithmetic, logic or data manipu- 
lation instruction was zero. 


« The Negative (N) bit is set if bit seven of the result of the last arithmetic, logic, 
or data manipulation instruction Is Set. 


» The Half Carry (H) bit is set if an ADD or an ADC instruction causes a carry 
to occur between bits 3 and 4 of the result. 


s The Interrupt Mask (1) bit is set when an external interrupt (INT) occurs. If 
another interrupt occurs (e.g. Timer Interrupt or INT2 ) when the I bit is set, 
the second interrupt is latched so that it can be processed as soon as the J bit 
is Cleared. The I bit can be set or cleared bv software. 





e The contents of the Stack Pointer (SP) are the address of the next available location 
on the stack. As previously discussed, the stack is only used to Keep track of the 
PC during subroutine branches, and all of the CPU registers during an interrupt. 
[Refs. 10: p. 6. 14: pp. 14-15] 
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6. Input 

Each MPU uses six input lines. Two of these lines, INT and INT2 , are inter- 
rupt lines that detect a negative-going edge on their respective lines. The other four lines 
are general purpose input lines on Port D. All of the pins on Port D are TTL compatible 
which made the hardware design relatively straightforward. The electrical character- 
istics for the input pins are listed on p. 2 of Ref. 10. 

The general operation of the two interrupt lines is described in Table 3 on page 
39. Once they are understood, interrupts are a simple vet powerful tool. Only three of 
the four interrupts available on the MC68705U3 are used by the Pan and Tilt programs. 
The software interrupt 1s not used. When the MPU is interrupted, current program ex- 
ecution 1s halted, the contents of the CPU registers are placed on the stack, and the 
MPU fetches the contents of the appropriate interrupt vector from memory. After the 
interrupt vector has been fetched, the PC is moved to that address and execution of the 
interrupt routine begins. There is no ambiguity when an external interrupt occurs since 
there is a dedicated interrupt vector in memory. The timer interrupt and INT however 
share the Timer Interrupt Vector. When one of these interrupts occurs, the interrupt 
routine must determine the source of the interrupt by checking the T!IR bit Of themaa 
and bit 7 of the MR to determine the source of the interrupt [Ref. 10: p. D1) 93e@iaem 
program execution resumes at the point at which the interrupt occurred when the inter- 
rupt routine executes a return from interrupt (RTI) instruction. 

The Function and Set lines on pins 20 and 21 are connected to the Function and 
Set switches. The operation of these switches is described in Table 2 on page 36. The 
remaining two input lines to each MPU are Channels A and B from the respective shaft 
encoders. The MPU programs use the information from these two inputs to determine 
the direction of rotation and to identifv repeated oscillations about a single transition. 

7. Output 

Each MPU 1s designed to provide position information at its output in two basic 
forms. On the Pan axis, in the Count Mode a number between -51,200 and + 51,200 
constitutes the output while in the Position Mode the output is an angle between 0° and 
360°. A five digit displav with a minus sign is sufficient for the count display. Using a 
five digit display with a decimal point in the Position Mode permits the angle to be dis- 
played to the nearest hundredth of a degree. This resolution is not quite as good as the 
resolution of the shaft encoders (+0.007°); however, final testing of the measurement 


system revealed that resolution 1s actually limited to about + 0.02° on the Pan axis and 


about + 0.14° on the Tilt axis. The five digit display is therefore completely adequate 
for this system. 

The Pan MPU uses 23 of its 24 output pins to represent the five digits, a minus 
sign and a decimal point. Each of the five digits is available in BCD form on four output 
pins of the MPU. The five digits are referred to as Digit 1, Digit 2, etc., with Digit 1 
being the least significant digit and Digit 5 being the most significant digit. Port A has 
as its Output the BCD representation of Digit 3 and Digit 4. Digit 1 and Digit 2 are 
represented by the output of Port C. The low four bits of Port B contain the BCD 
representation of Digit 5. These 20 output lines are the input to five 74LS47, 
BCD/;7-Segment Decoder; Drivers, which decode the BCD signals and drive the common 
anode LED indicators. The output from Pin 29, PB4, is one input to a 74LS32 OR gate, 
the output of which is used to blank leading zeros out of the display. Pin 30 is not used 
and is tied to ground. The remaining two output pins drive two LED segments in the 
display. The signal on pin 31 turns the minus sign off and on, and the signal on pin 32 
determines whether the decimal point 1s displayed. 

The electrical characteristics of the 1,O Ports are given on p. 4 of Ref. 10. The 
output characteristics of Ports A, B and C are compatible with the input characteristics 
of the 74LS47 and the 74LS32 given on pp. 4-59 and 4-48 of Ref. 11. The pins on 
Port B are capable of sinking 10 mA when Port B is configured as an output port. A 
220 Q resistor placed in series With each of the display segments limits the current to 
approximately 9 mA and permits the MPU to drive the decimal point and minus sign 
directly. 

One consideration in the design of this system was to provide a system capable 
of being readily expanded to meet changing needs. To this end, in addition to being 
connected to the LED display devices via the 74LS47’s, the BCD data lines are also 
connected to a header on each of the MPU circuit boards. If, at a later date, the posi- 
tion information needs to be used in another system, a jumper connected to each of the 
headers could provide the information with little or no modification. 

The Pan and Tilt signal processing subsystems are virtually identical in the 
hardware used to implement them. The only difference is that the Pan system has a five 
digit display, and the Tilt system needs only four digits to display its position informa- 
tion. Consequently, the Tilt system does not use Digit 5, and pins 25-29 are tied to 


ground. 
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Each digit represented in BCD at the output of the MPU 1s decoded by a 74LS47 
BCD’'7-Segment Decoder/Driver. The decoding devices each convert a four bit BCD 
representation of a number into seven signals that each drive a separate segment of a 
common anode, seven segment, LED display. The 74LS47 1s capable of sinking 24 mA 
from each of the LED segments. Without a current limiting resistor between each of the 
output pins on the 7447 and the corresponding pin on the display element however, this 
maximum current is exceeded. When this happens the LED’s have a very short life, the 
7447 overheats and the system fails to function properly. The addition of a 220 Q re- 
sistor in each branch limits the current to about 9 mA per segment, and permits 
trouble-free operation. 

Three of the output pins on each MPU are not used as inputs to the 7447's. As 
discussed in the previous section, the Decimal and Minus lines each drive individual 
LED segments directly. The third line, also mentioned briefly in the preceding section, 
is used with the Blanking In’ Ribbon Blanking Out (BI, RBO) signal from Digit 4’s 7447 
to determine the Ribbon Blanking In (RB1) signal into the 7447 which drives the display 
for Digit 3. 

The term “blanking” simply means removing the leading zeros from the display. 
The two display modes available from the MPU’s have different blanking requirements. 
In the Position Mode the three least significant digits are not blanked, while in the 
Count Mode, all but the least significant digit are blanked. The RBI and BI/RBO pins 
on the 7447's, the Blank line out of each MPU and the OR gates, connected as shown 
in the schematics in Appendix A, provide this capability. 

The Light Test (LT) pin on each 7447 1s connected to SW5. When the switch 1s 
closed, the Light Test line goes low and each of the output lines on each of the 7447's 
also goes low, thus sinking current from all of the LED segments simultaneously. This 


feature allows the operator to check for inoperable display segments. 


G. POWER SUPPLIES 

The two power supplies shown in Figure 2 on page 6 are each +5.0 Vdc supplies. 
The power supply which provides power to the shaft encoders and the line drivers 1s 
physically mounted in the camera housing. It was built by modifying the +12 Vdc auto 
iris power supply. This was accomplished using an LM7805 Voltage Regulator in the 
manner shown in Figure 8 of Appendix A. The auto iris requires only 100 mA at 


+ 12 Vde for correct operation, and the LM{7812 Voltage Regulator has an available 
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output current of 1.0 A [Refs. 15, 16]. The remaining 900 mA ts available to the 
LM7805 to power the encoders and the line drivers. Reference 9 Itsts the maximum 
power requirement for the ITEDS-600 as 40 mA at +5 Vdc, and Ref. 11 spectfies the 
inaximum power requirement for a 748140 is 1 mA at +5 Vdc. ‘Thus, the 84 mA re- 
quirement for the two encoders and four line drivers ts well within the capabilities of the 
modified power supply. 

The second power supply is capable of providing 6.0 A at +5 Vdc which ts more 
than adequate to provide the 1.4 A needed by the signal processors and the display de- 
vices. The power supply also has 12 Vdc and -5 Vdc ports. To preclude the potentially 
disastrous results which might occur if the power supply were incorrectly connected to 
the stgnal processor/display devices, the circuitry shown in Figure 21] was included on 


each MPU and display printed circuit board. 


vain A 
Pico-fuse 


Sal Vv 
IN 3826 
Zener diode 





Figure 21. Reverse/Over-voltage Protection Circuit 
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IV. CALIBRATION , TESTING AND IMPLEMENTATION 


A. GENERAL 

Once the basic system design had been completed, and the MPU programs had been 
written, a prototype svstem was constructed. The prototype system might also be called 
the development model, since it was not only used to test the design , but was also used 
to calibrate the MPU programs. A block diagram of the prototype system is shown in 
Figure 22. The M68705EVM Evaluation Module (subsequently referred to as the 
EVM) provided the capability to debug and evaluate the MC68705U3-based signal 
processing subsystem. Operation of the signal processing MPU was performed by an 
MC68705U3 resident on the EVM. 

The prototype system provided considerable flexibility in the testing and calibration 
of the svstem. The assembly language programs for the MPU’s were written and edited 
on the PC. Thev were then assembled and linked using the 2500 A.D. 6805 Cross As- 
sembler and 2500 A.D. Linker [Ref. 17: pp. (1-1)-(2-38)]. The result, a Motorola $19 
output file (see [Ref. 17: pp. (A-1)-(A-4)]), was then down-loaded to the EVM using the 
file transfer program, Kermit. Downloading procedures are detailed in [Ref. 18: pp. 
(3-10)-(3-25),(3-37)]. The PC-EVM interface is shown in Figure 23. 

After the program had been down-loaded into the MC68705U3 resident on the 
EVM, data entry and program debugging were controlled via the CRT monitor key- 
board. The CRT-EVM interconnection is shown in Figure 24 and the monitor con- 
mands are described in [Ref. 18: pp. (3-8)-(3-25)]. 

The remainder of the signal processing functions were realized using hardware ex- 
ternal to the EVM. These functions included edge detection of the output signals from 
the shaft encoders, decoding the output of the MPU, and generating the signals to drive 
the display devices. This portion of the prototype, referred to by [Ref. 18] as the “target 
system”, was built on breadboards and is represented by the block in the center of 
Figure 22. The target system was connected to the MCU via a 40-pin jumper header, 
J1, on the EVM. The pinout for J] is shown in Figure 25. The labels in Figure 25 refer 


to the labels used in the schematic diagrams which are shown in Appendix A. 


B. CALIBRATION 
Once the MPU programs were capable of counting the pulses generated by the shaft 


encoders, the programs needed to be “calibrated”. This calibration procedure required 
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Figure 24. Monitor - Evaluation Module Connections 
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Figure 25. Evaluation Module - Signal Processor Connections 


determining the angular distance through which the camera rotated between successive 
pulses from the shaft encoder. This number is a scale factor, which, when multiplied by 
the total number of pulses from the shaft encoder, yields a number equal to the angular 
displacement of the camera. The calibration procedure also involved determining the 
amount of hysteresis present in each of the gear trains. 

1. Scale Factor 


To determine the scale factor (SF) the simple geometric relationship 


_._-1/ opposite 
earn ( adjacent ) ve) 


was used. Using a small laser attached to the camera servo, and the geometry shown in 
Figure 26, the SF could be experimentally determined. As the camera servo was rotated 
through an angle, 6, the MPU was used to count the output pulses from the shaft en- 
coder. The laser beam was projected on a vertical surface at a distance, a, away from 
the axis of rotation. The beam of the laser spread to a diameter of approximately 0.4 
in. over a distance of 30 ft. A template with a 0.4 in. diameter aperture was used to mark 
the location of the “spots” on the distant wall. The distance between the spots, /, was 
measured by selecting one edge of one of the marks and measuring the distance to the 
corresponding edge of the distant mark. Then, having determined / and a and reading 


the count, C, from the displav, the SF could then be determined from 


SF(degrees/Pulse) = a 
he 
can"( SE | (13) 
a(in) 
C 


Using Equation (13) to simplify the expression, 


aE ag (14) 


lens Fl 5a 


yields 
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Figure 26. Geometry Used to Determine the Scale Factor 
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which indicates that C, a and / should all be as large as possible to munimize the error 
in SF due to a measurement error in a or /. The physical size of the laboratory limited 


the distance, a , to 30 ft. When a= 30 {t, / was limited to about 3.5 ft in the horizontal 


plane and about 4.0 ft in the vertical plane. By modifying the geometry as shown in 
Figure 27, the count, which from Equation (13) is directly proportional to @, could also 
be maximized. The configuration shown in Figure 27 was used to obtain the scale fac- 
tor calibration data for the Pan axis. Hlowever, since the servo is incapable of rotating 
360° about the Tilt axis, the test configuration shown in Figure 26 had to be used the 


collect the data for that axis. 
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Figure 27. Alternate Geometry Used to Determine the Scale Factor 


Adopting the notation, X, to represent the mean value of a randoin variable, 


X; 1f X is discrete with N measured values, 


N 
= 
> ~t D4, (16) 


where A’ is the ‘th measured value of X, and the approximation becomes better as N 
approaches infinity. 

Using the expression in Equation (16) and the measured data for the scale fac- 
tors, from 31 measurements on the Pan axis, 


SF pan = (7.0312 x 107*)°Pulse™’ , (17) 
and after 32 measurements on the Tilt axis, 
SF ri, = (7.0452 x 107*)°Pulse™! , (18) 


where the subscripts indicate the axis. The actual implementation of these scale factors 
is described later in this chapter and in the documentation for each of the MPU pro- 
grams. 


If the error in the ‘th measurement 1s described bv 
c= Xj = ’ (19) 


then the root mean square (RMS) error in N measurements of X is given by; 


N 
.o< 
o, = [x Doin? (20) 
i=) 


Note that this is also the definition of the standard deviation of X. 
The RMS errors in the Pan and TJilt scale factor measurements were determined 


from Equation (20) and the measured data to be; 


Os,,. = (4.62 x 10-°)*Pulse™ (21) 
Gop = (6189 x)108 ) Ruse (22) 


As before, the subscripts are used to identify the axis and the source of the error. The 
fact that the errors are small compared to the mean values suggests that the means 
should closely approximate the actual values for the scale factors. 

2. Hysteresis 


be 


Houghton defines backlash in wormgearing as “...the total plav between the 
surfaces of the worm and worm wheel teeth measured normal to the faces.” [Ref. 19: 


pp. 1.4. 1.5] Backlash onlv poses a problein in the measurement svstem When the servo s 
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direction of rotation changes. Figure 28 is a typical hysteresis curve. As long as the 
direction of rotation of the worm is increasing the Oyorm/Owormoear relationship 1s linear. 
However, when the direction of rotation reverses there is a region, depicted by the left 
pointing arrows, where the position of the worm changes without a corresponding 
change in the position of the wormgear. Note that once all of the backlash has been 
taken up the Oworm/Owormoear relationship is again linear until the direction of rotation 


changes. 


A, ORMGEAR 





Figure 28. Typical Hysteresis Curve 


The purpose of the hysteresis buffer in the MPU is to permut the signal 
processor to account for the backlash error introduced into the measurement bv the 
worin-wormgear connection. The theory of operation for the buffer is relatively straight 
forward and is best described by the flow diagram in Figure 29. The buffer is a data 
byte in the MPU RAM. As long as the buffer is full, 1.e., the contents are equal to the 
predetermined buffer length, a clockwise (CW) signal from the shaft encoder (increasing 
elevation and increasing azimuth are defined as CW rotation for the purposes of this 


system) causes the position counter to be incremented. Similarly, counter-clockwise 


Figure 29. 
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Ficure 30. Hysteresis Curve 


(CCW) signals cause the position counter to be decremented if the hysteresis buffer 1s 
empty. 1.e., the contents are equal to zero. These two situations correspond to the two 
linear sections in Figure 28. From Equation (13), the horizontal separation of these two 


lines 1s related to the length of the hysteresis buffer, C,, by the expression 


AG, 


Scr 





(23) 


Similarly, using the SF to map @\opy, into C, and the fact that the displacement of the 
wormegear equals the displacement of the axis of interest, the curve shown 1n Figure 30 
can be obtained from Figure 28. From Figure 30 it is apparent that two different pulse 
counts can be obtained for anv given position, 6, depending on whether that position is 
approached from a CW or a CCW direction. The difference in the two counts is a 
measure of the hysteresis present in the gear train and is also the required length for the 
hysteresis buffer. By using this difference as the length of the hysteresis buffer, counts 


received by the MPU which occur while the gears are operating on one of the horizontal 
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sections of the curve in Figure 30 are not considered “valid” and therefore do not cause 
the MPL to modifv the position. Using Equation (23) and data collected in the labo- 
ratory the average hvsteresis present in each of the gear trains was determined (from 45 


measurements on the Pan axis and 30 measurements on the Tilt axis) to be 


Cipany = 7-39 Pulses (24) 
Cuctiny = 6.06 Pulses (25) 


and the RMS errors were calculated to be, 


= 1.0 Pulses (26) 


Ce ripenl 


Core OS Ieruises = (27) 


C. IMPLEMENTATION OF THE CALIBRATION DATA 
1. Background 

Figure 31 outlines the basic operation of each of the MPU’s. Although each 
of the routines 1s described in detail by the comments included in the programs, the op- 
eration of the Count Routine 1s the heart of the program and should be explained prior 
to discussing the actual implementation of the experimental results. 

When the svstem operator causes the camera servo to rotate, each optical shaft 
encoder translates the displacement of one of the axes into two series of digital pulses. 
The two pulse trains, referred to as Channels A and B, are TTL logic level signals. When 
the logic level of Channel A transitions from low to high (rising edge transition) or from 
high to low (falling edge transition), the edge detector (See Figure 15 on page 33) pulls 


pin 3 of the associated MPU low for approximately 2 wsec. When this occurs an ex- 





ternal interrupt (EXT INT or INT ) request is generated and the MPU begins execution 
of the Count Routine. 

As mentioned in Chapter III, since both rising and falling edge transitions are 
detected bv the edge detector, the signal processor must be capable of detecting multiple 
oscillations of the shaft about a single logic level transition point. Accordingly, the first 
tasks performed by the Count Routine are to determine the direction of rotation and to 
simultaneously determine whether the interrupt 1s the result of a stationary shaft oscil- 
lation. To do this the Count Routine checks the state of pin 17 (Channel A) and pin 


19 (Channel B). Operation of this portion of the routine is summarized in Table 5S. 
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Figure 31. Program Flow Diagram: Program executes in the Wait Loop until; (a) 
the operator requests to modify the hysteresis buffer, (b) the operator 
requests to change the display mode, (c) an external interrupt is gener- 
ated by the Channel A edge detector or, (d) a timer interrupt causes the 
display mode to “blink”. All interrupt routines are ternunated with a 


return from interrupt (RTI) command. 


Note that CW rotation is indicated when Channel B leads Channel A in phase and CCW 
rotation is indicated if Channel A is leading Channel B. The possibility of erroneously 
counting multuple oscillations about a single point is eliminated by “counting” only the 
leading edge transitions when the shaft 1s rotating CW and only the trailing edge tran- 
sitions when the rotation is CCW. All other transitions cause the program to execute 
a “return from interrupt” (RTI) instruction. 
2. Implementing the Hysteresis Buffer 
The transitions that are to be counted cause the program to compare the con- 
tents of the hysteresis buffer, HYSTCT, and the direction of rotation to the exper- 
imentally determined buffer length, HYST~C,,. If the rotation is CW and the buffer is 
full (.e., HYSTCT=HYST), or if the rotation is CCW and the buffer is empty (..e., 
HYSTCT=0), then the “slack” due to the gear backlash should have been taken up , 
the transitions are considered “valid” and the MPU modifies the position appropriately. 
“Invalid” counts cause the contents of the hysteresis buffer to be incremented or decre- 
mented depending on whether the present direction of rotation is CW or CCW 


( Pigure Zo sneters): 


Table 5. COUNT ROUTINE LOGIC 
Direction Count the 
; . : Increment the 
the position. 
: Decrement the 
Te ea Sa 
Cie [ oe [eee 
the position. 


From the calibration data for the Pan axis, Co. and ¢¢,,..,,=1.0. Because 










the length of the hvsteresis buffer must be an integer value, Ge needed to be rounded 
off. Rounding to the nearest whole number initiallv seemed the most logical approach. 
Upon further consideration, however, it was decided to round 7.4 up to 8. Considering 
the relatively small data base (45 measurements) upon which the average was based, the 


fact that the standard deviation was 1.0 and that the gear backlash will only increase 


with time, this seemed like the most reasonable approach. The buffer length for the Tilt 
axiS Was set equal to 6 Gi = 6.06) . 
3. Implementing the Scale Factor 

There are three counters in each MPU that keep track of the position informa- 
tion for the axis of interest. The first, BINCT, is simply a binary counter that is incre- 
mented by one for each valid CW count and decremented by one for each valid CCW 
count. The other two counters consist of two sets of pointers, two sets of data registers 
and a shared data table. Each byte in a pointer points to an address in the table that 
contains two BCD digits which make up a portion of the position information. 

In order to increment (decrement) the pulse count, BCDCT, by one, the count 
pointer, CTPTR, is incremented (decremented) by one causing it to point to a new table 
address. The contents of the table at the new addresses are then moved into BCDCT. 
Modification of the position counter, DEGRES, 1s performed in much the same manner. 
DEGRES contains a BCD number that, when multiplied by 0.001, represents the angu- 
lar position (in degrees) of the shaft of interest. Thus, each time the camera is displaced 
ina CW direction through one degree, the contents of DEGRES should be incremented 
by 1000. To do this. the position pointer, PIR, must be incremented (decremented) by 
seven or eight each time CTPTR is incremented (decremented) by one. Incrementing 
PTR by seven corresponds to an angular displacement of 0.007° and since 
SFp., and SF;,, are each slightly larger than 0.007°, periodically PTR must be incre- 
mented by eight to reduce the cumulative round off error. Specifically, if PTR is incre- 
mented by seven each time a valid CW pulse is detected (except when BINCT 1s an even 
multiple of 32) and is incremented by eight when BINCT is a modulo 32 number, the 


effective scale factor is given bv: 


! 
SF eg, = =z (31(0.007) + 0.008) (28) 
= (.00703125°Pulse! , 


which is slightly larger than the desired 0.0070312°Pulse-', for the Pan axis and slightly 
smaller than the desired 0.0070452°Pulse-! for the Tilt axis. To further reduce the cu- 
mulative round off on the Pan axis, every 16,384 (2'* = 32 x 512) counts PTR is incre- 


mented by seven instead of eight. This results in an effective scale factor of, 
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l l 3 
Sy == {su 35 G10) + 8)x 10 | + 0.007] 


= (7.03119 x 107°)°Pulse™ , 


(29) 


which 1s within two parts in one million. 

The maximum error introduced into the measurement should occur when the 
camera is rotated through the largest possible angle. To predict this error on the Pan 
axis, when the camera has been displaced by 360°, 

4 ° 
BeDeh =e 


SF pan (30) 
= S100 T Wises 


so the position error using SF,, and SF,,, should be; 


Cpan = 360° — [3(SFeg,) + (51,200 — 3(16,384))(Sey-) 


31 
= 002757 GY 


Thus, the error due to the scale factor on the Pan axis should be well within the desired 
resolution of + 0.006° . 
Using SF, alone as the scale factor for the Tilt axis, the maximum theoretical 


error over +12° due to the scale factor round off is determined in the same manner. 





40 
BCDCT = == 
Frit (32) 
=— 1) OS35'F Wises 
Socthat: 
Crit = [= 17,033(SF ey ) (33) 


= 0.0234° , 


which again is significantly less than the required resolution of +0.23° for the Tilt axis. 

The final step in the Count Routine is a branch to the Displav Routine. De- 
pending on whether the MPU is in the Count or Position Mode, the Display Routine 
copies the contents of BCDCT or DEGRES to the output ports and then executes an 


RTI instruction. 





D. FINAL TESTING 
1. General 

Final laboratory testing and evaluation of the measurement svstem was per- 
formed after the calibration results had been implemented in each of the MPU Count 
Routines. The purpose of the testing was to verify that the calibration results had been 
properly coded into the MPU’s and to determine the resolution capabilities of the 
measurement system experimentally. 

This verification process included determining the combined error due to the 
hysteresis and scale factor errors. The use of some simple multiple random variable 
theory was therefore required. From [Ref. 20: pp. 121,122] the variance of a weighted 


sum of M random variables is the weighted sum of their covariances, Cy xy and is given 


by, 


MoM 
2 4 
GC = De ee ey, ; (34) 


i=) j=} 


where o, 1s the weight associated with X,. Additionally, the covariance can be expressed 


as 
Cxy = poxay , (35) 


Where p is the normalized second-order moment and is known as the correlation coefhi- 


cient of X and Y. The correlation coefficient is bounded by 
wa S(O (36) 


In the case where there are two equallv weighted random variables, M=2 and 


%, =o,=1.0. Substituting into Equation (34) and expanding 
COG Cort Cy, (37) 
Using Equation (35), 
o = 0x + 2payay +0% . (38) 
Combining (36) and (38) vields 


2 ji 2 2 
Oy —2aoyoy +aysa Soyt ayay+ oY , (62) 
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The bounds of the combined scale factor and hvsteresis errors can therefore be deter- 


mined from 


jae 2 pe: 2 
Vi Fee — 20 ec .Fe, + Fe, Ss Ge Sf Og nd CO pee ae ee (40) 


where: 
© o,=standard deviation of the combined error, 


0... = standard deviation of the scale factor error, and 


° o,, = standard deviation of the hysteresis error. 


Note that the bounds are determined bv the two cases where the hvsteresis error, e,, and 
the scale factor error, e,;, are “completely correlated”. The upper bound corresponds 
to the case where an increase in e.- implies an increase in e,, and the lower bound cor- 
responds to the case where an increase in e,; directly implies a decrease in ey. 

A third case is also of particular interest. If e, and e,, are completely uncor- 


related, 1.e., 9 = 0, then from Equation (38), 


FS 2 
O eme 6 RD ae (41) 
which can also be written as 
2 2 


where e = + a, 18 the 1.0 o error due to the scale factor and hysteresis errors, ¢c- samme 
respectively. Based on the physical nature of the two errors it 1s reasonable to assume 
that e,- and e, are statistically uncorrelated; however, no experimental data was collected 
to support this hypothesis. Due to this lack of a priori information, the maximum RMS 


CITOL. Cnax — = Geng el vena 
i> > 
—_ ‘ <= ay “ 
Cmax =~ Ly spt -CsreH ten (43) 


will be used to describe the resolution capabilities of the measurement svstem. 
2. Pan Axis 
a. Hysteresis 
To test the operation of the Pan axis hysteresis buffer, the Initialization 
Routine was programmed to set the buffer length to 8. Then, as described in the first 
secuon of this chapter. the servo was used to position the beam of a small laser on a 


fixed target. By approaching the target alternately from a CW and a CCW direction and 
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comparing the difference in the output counts from the shaft encoders, the hysteresis 


error was determined. The average error after 31 measurements was 


€H(Pan) = —(). 1880 Pulses ’ (44) 


and the RMS error was 


Ce = 1.7699 Pulses . (45) 
H(Pan) 
Since the mean error is “near zero” compared to the standard deviation, the 1.0 o error 


ey, due to the hysteresis can be determined from 


ey = + (o,,)S (46) 


so that 


©H(Pan) — ae 0.0124° ° (47) 


b. Scale Factor 

Verification of the scale factor was performed in the same manner as the 
scale factor calibration, except that the MPU was calibrated in the Count Mode and 
tested in the Position Mode. Since these tests sought to find the maximum error due to 
the scale factor, and the error is directly proportional to the angle that is being meas- 
ured, these tests Were conducted bv displacing the camera servo through the maximum 
angles permitted by the camera and the laboratory. Specifically. on the Pan axis the 
servo was rotated through approximately 360°. The mean error due to the scale factor 


on the Pan axis was determined from 15 samples to be 


Esripan) = —0.0018° (48) 


and the RMS error was 


o.... = 0.00890° . (49) 


€SF i Pan) 


As with the hysteresis error, if we neglect the small bias due to the €cp,p,,, , We can de- 


scribe the 1.0 ¢ RMS error due to the scale factor as 


€sF(pan) = + OsF(Pan) 


= + 0,00890° * i) 
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c. Combined Error 
From Equation (42) the combined error on the Pan axis if e, and e,, are 


uncorrelated can be estimated as 


Cpan = + x/ (0.0124)? + (0.0089) 


(51) 
=+0.01526° . 


And from Equation (43) the maximum combined error on the Pan axis 1s 


Cpan.. = + / (0.0124)" + 2(0.0124)(0.0089) + (0.0089)” (52) 





The combined error is approximately three times larger than the design specification 


limit and is due primarily to the hysteresis error. 
3. Tilt Axis 
a. Hysteresis 
The procedure used to verifv the operation of the calibrated Tilt MPU was 
identical to that described in the previous section. Using a hysteresis buffer length of 6 


resulted in 


Cr tuy = —0.0965 Pulses (54) 


and, 


o = 1.3156 Pulses (55) 


CH( Tilt) 
after 13 samples. As before we can define the 1.0 o error from e = oSF to be 
€y.,, = + 0.00529" . (56) 
b. Scale Factor 
Testing the scale factor on the Tilt axis was lhmited by the physical con- 
struction of the servo and the size of the laboratory. The angle over which testing could 


be performed was limited to + 6° from the horizontal plane. Consequently, the RMS 


error for the scale factor on the Tilt axis was determined in exactly the same manner as 
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the RMS error for the Pan axis scale factor, but since the error due to rounding of the 
scale factor is directly proportional to the angle being measured the results were multi- 
plied by 2.0 to account for the limited range of the test. The modified results should 
therefore be representative of the maximum error one should expect if the measurement 
system is used to measure elevation angles over a range of + 12°. 


The error due to the scale factor is described from 16 samples by 


es F(Tilt) = 0.0070° lon) 


and, 


0, =0.0665° . (58) 


€SF(Tilt) 
Including the factor of two in the calculation we have 


€sFrtin) = + 2(0.0665°) 


Sy 
= =4081330° . o) 


c. Combined Error 
The combined RMS error is determined in the same manner as before. If 


emeanad €.. are uncorrelated, 


(60) 

~Oeel: « 

and the maximum combined RMS error 1s 
ery = £ (0.1330)? + 2(0.1330)(0.00529) + (0.00529) (61) 


Siilte., = == OsS3° « 





The Tilt axis measurement system appears to perform well within the required resolution 


specifications. 
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E. FINAL IMPLEMENTATION 

Once the program debugging, calibration and testing were completed, final imple- 
mentation of the svstem remained. Taking the design from the prototype’/development 
model to a fully functional svstem was a straightforward but time-consuming evolution. 

The plans for the printed circuit boards (PCB's) were made directly from the sche- 
matics shown in Appendix A; the boards were then etched and assembled from the plans 
which are shown in Appendix B. All of this work was performed by sailors attached to 
the Academic Division of the NPS. 

As previously discussed, the M68705EVM Evaluation Module provided a powerful 
and flexible means of debugging and evaluating the performance of the microprocessor 
based signal conditioner. Additionally, once program testing was completed the EVM’s 
EPROM microprocessor programmer provided the means to program the EPROM 
MCU’s. A detailed. but simple to follow, programming procedure for programming the 
MC68705U3 1s given in [Ref. 18: pp. (3-26)-(3-27)]. 
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V. CONCLUSIONS AND RECOMMENDATIONS 


A. SYSTEM PERFORMANCE 
The prototype system was calibrated and successfully tested in a laboratory environ- 
ment. Experimental results indicate that the system is capable of measuring the video 
camera's elevation over a range of +12° with a resolution of +0.138° and its azimuth 
over 360° with a resolution of +0.021°. The system was designed to be low cost, reliable, 
and easy to operate. Onlv time will tell whether these objectives were truly achieved. 
The portion of the system that will be located outdoors has been weatherproofed 
and is ready to be placed in service. Printed circuit board plans for the remainder of the 
system have been developed, but final implementation of the system is still ongoing. 
Once the system 1s fully operation additional testing should be performed in order to 
verify the completed system’s performance. Although the laboratory results indicate 
that the system is capable of meeting all of the design criteria except for the required 
resolution on the Pan axis, the system must be further tested in a non-laboratorv envi- 
ronment. “...The proof of a good design rests in the ability of the system to function in 
the outside world.” [Ref 21] 


B. RECOMMENDATIONS FOR FURTHER WORK 
There are several areas for follow-on work with this project. Some possibilities are: 


e Incorporate the measurement svstem’s Output into the video image being created 
by the video camera. This would permit a permanent record of the position infor- 
mation to be stored with the video image and would facilitate identification of the 
image at a later date. 


e Design and build an automatic feedback control system for the camera. 


e Implementation of a second video camera at the NPS, together with the NPS 
modified IRSTD, would permit triangulation of a target and would consequently 
provide range information which 1s not currently available. This information could 
provide valuable additional information to those who are developing the signal 
processing algorithms. 
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APPENDIX A. SCHEMATIC DIAGRAMS 
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APPENDIX B. PRINTED CIRCUIT BOARD PLANS 
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APPENDIX C. MICROPROCESSOR PROGRAMS 


A. GENERAL 

Sections B and C of this Appendix are the listing files for the two MPU programs 
written for the signal processor subsystems. The theory of operation of the two pro- 
grams is identical and is most clearly described by Figure 31. The detailed operation 
of the Initialization , Mode Change, Blink, Output Display and Hysteresis Modify rou- 
tines is described by the comments which accompany each of the programs. In addition 
to the detailed description provided by the program comments, the operation of the 
Count Routine is also explained in Chapter IV. 
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a 
OO OA UW & WA = 


a 
=> 


12 


PAN 


0000 
0001 
0002 
0003 


0004 


re 


** PROGRAM DESCRIPTION 


POSITION DETERMINING PROGRAM (AZIMUTH) 
LATEST REVISION 9 MAY 89 
FILE NAME PAN .ASM 


** 1/0 REGISTER ADDRESSES 


#2 


PORTA  EQU 
PORTB EQU 
PORTC EQU 
PORTD EQU 


£2 


$0000 
$0001 
$0002 
$0003 


1/0 PORT A 
1/0 PORT 8 
1/0 PORT C 
INPUT PORT D 


** DATA DIRECTION REGISTER OFFSET 


2 


DOR EQU 
ak 

** OTHERS 
ak 

TIMER — EQU 
TCR EQU 
MR EQU 
RAM EQU 
ZROM = EQU 
ROM EQU 
MOR EQU 
INTRPT EQU 
MEMSIZ EQU 
xt 

** EQUATES 
gk 

BITO = EQU 
BIT1 EQU 
BIT2 QU 
BIT3. - EQU 
BIT4  EQU 
BITS  EQU 
BIT6 QU 
BIT7  EQU 
ae 

BO EQU 
Bt EQU 
B2 EQU 
B3 EQU 
B4 EQU 
B5 EQU 
B6 EQU 
B7 EQU 


eK 


4 


NSO uw & WA = © 


(eg. DOR FOR PORT A IS PORTA+DDR ) 


EIGHT BIT TIMER REGISTER. 

TIMER CONTROL REGISTER. 

MISCELLANEOUS REGISTER. 

START OF ON-CHIP RAM(112 - 31 FOR STACK) 
PAGE ZERO OF ROM. 

START OF MAIN ROM. 

MASK OPTION REGISTER. 

LOCATION OF INTERRUPT VECTORS. 

MEMORY ADDRESS SIZE. 


** EQUATES FOR THE TIMER CONTROL REGISTER 


TIR EQU 
TIM EQU 
TIN EQU 
TEE EQU 
PSC EQU 
PS2 EQU 
PS1 EQU 


=—= WW & WO = 
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TIMER INTERRUPT REQUEST. 1 = REQUEST, O = NO REQ. 
TIMER INTERRUPT MASK. 1 = DISABLED, O = ENABLED. 
EXTERNAL OR INTERNAL CLOCK SOURCE. 1 = EXT, O = INT 
EXTERNAL CLOCK ENABLE. NOT USED. 

PRESCALER CLEAR. NOT USED. 


(PS1) |-- PRESCALER SELECT BITS. 


0000 


0007 
0006 


0004 


0007 
0006 
0005 
0004 


PSO 


kek 


EQU 0 (PSO) -- 


** EQUATES FOR THE STATUS BYTE, ‘STAT’. 


kak 


eke 


EQU is COUNT DIRECTION? 1 = UP, 0 = DOW. 
EQU 6 IS ‘BINCT’ MOOULO 32? 1 = YES, O = NO. 
EQU 5 BLINK THE DISPLAY? 1 = YES, O = NO. 
EQU & DISPLAY POSITION OR COUNT? 1 = POS, 0 = COUNT. 
EQU 3 VALUE OF ‘MODE,PORTD’ LAST TIME. 
EQU 2 IS ‘BCOCT’NEGATIVE NUMBER? 1 = YES, 0 = NO. 
1 NOT USED. 
0 NOT USED. 


** 1/0 EQUATES AND DESCRIPTIONS. 


Ree 
kkk 
RKk 
rk 
eke 


Rk BIT 


PORT A (1/0) 
Hoccceee te-cce-- Hocceeee torecece Heoerceee- teoreeee- Heeccccee Hoeccece ~ 
| BCD DIGIT #4 | BCD DIGIT #3 | 
teece--- +------- Heer ccee Hoececee Heccccee Hocceeee Heocecee Hoccceee + 
| DS | co | B4 | AG | D3 | cs | B3 | AZ | 
teoo----- toe----- Heoeceeee teoeceee- Heccecee teccceee Hocccece Heocceee “ 
7 6 5 4 3 2 1 0 
PORT B (1/0) 
+------- +--e---- +-ce--ee Hrereeee teececee teecceee teeceee- +eo--e-- + 
DISPLAY CONTROL - | BCD ei #5 ik ate SIGNIFICANT) | 
+--+----- Heore--e Heooceeee Hocceee- ee. ee +-2----- + 
| DECPT | POSTIV| | BLANK | b5 i c5 | B5 | AS | 
Heecee-e teccceee Heccceee Heoccecee teocceee teocceee teccccee tecccee- + 
7 6 5 & 3 2 1 0 
EQU 7 TO DISPLAY THE DECIMAL POINT...DECPT IS CLEARED 
EQU 6 USED TO DISPLAY NEGATIVE SIGN...CLEARED TO SHOW 
MINUS SIGN. 
EQU 4 TO BLANK DIGITS 2 AND 3...CLEAR BLANK. 
DIGITS 4 AND 5 ARE ALWAYS BLANKED. 
DIGIT 1 IS NEVER BLANKED. 
PORT C (1/0) 
Hoeceee- Hecceeee Heoccee- teccecee tocceeee Hoeceeee teccceee Heeceeee ~ 
| BCD DIGIT #2 |BCD ae #1(LEAST on ee 
+---2--- +--o----- #--2----- Ho-ec-eeee er en Horr cee tee -- © 
| b2 | c2 | Be. | A2 | D1 | c1 | B1 H Al | 
Ho------ Heece--- teoeee--- H------- Heecceee Ho---ee- H------- +--e-ee 4 
7 6 5 4 3 2 1 0 
PORT D CINPUT ONLY) 
Heo------ $--e-- ee +-o--ee- Hocecene Hoo cece teoercces Hrecceee +------ + 
| CHA | INT2 | CH_B | FUNCT | SET | | | 
+------- He-e-ee- teecce-e- Hos cce-e teee-eee Heere--e toeeeee- Heeceee + 
7 6 5 4 5 2 1 0 
EQU 7 INDICATES THE STATUS OF CHANNEL A. 
EQU 6 INTERRUPT #2. USED TO CHANGE DISPLAY MODES. 
EQU 5 INDICATES THE STATUS OF CHANNEL B. 
EQU 4 USED TO PUT THE PROGRAM IN A MODE THAT WILL ALLOW 


89 


0000 


0000 


0010 


0010 


0013 


0017 


OO1A 


OO1E 


0021 


0003 


0010 
0011 
0012 


0013 
0014 
0015 
0016 


0017 
0018 
0019 


OO1A 
0018 
001C 
001D 


OO1E 
OO1F 
0020 


bhi ‘HYST’ TO BE INCREMENTED. 
SET EQU 5 INCREMENTS ‘HYST’ WHEN TOGGLED AND FUNCT IS LOW. 


eee 
arr 
REESE EAACEAEEAEE CAAA KAREAAAETEE CAAA EAEAEAEEEAEAE EAE EAKEAHKEAERENEE 


rer ® 
a RAM VARIABLES - 
. a ® 


AREER EAA AAEEAEEAEAKEREEAEAAAEEEEEREREEEEREEEEEAEEAEEEEE 
ae 


** RESERVE MEMORY SPACE FOR THE PROGRAM VARIABLES. 


ae 
DATA 

=e 

we 


ABSOLUTE CABSOLUTE ADDRESSING USED HERE TO RELATIVE DIRECTIVE) 


ae 


ORG = RAM START OF RAM. 
ww 
*** BINARY COUNT. 
BINCT RMB 3 
HIBIN QU BINCT HI BYTE. 
MIDBIN EQU -— BINCT+1 MIDDLE BYTE. 


LOBIN EQU BINCT+2 LO BYTE. 

tt 

*** POSITION POINTERS. 

PTR RMB 4 EACH BYTE POINTS TO A POSITION IN THE 
lal TABLE THAT CONTAINS ONE OR TWO DIGITS 
‘dal OF THE BCD POSITION. 

PTR4 EQU PTR MOST SIGNIFICANT DIGITS. 

PTR3 EQU PTR+1 

PTR2 EQU PTR+2 

PTR1 EQU PTR+3 LEAST SIGNIFICANT DIGIT. 

we 

*** COUNT POINTERS. 

CTPTR RMB 3 EACH BYTE POINTS TO A POSITION IN THE 
bi’ TABLE THAT CONTAINS TWO OF THE DIGITS 
=< IN THE BCD COUNT. 


CTPTR3 EQU CTPTR MOST SIGNIFICANT DIGITS. 
CTPTR2 EQU CTPTR+1 


CTPTR1 EQU CTPTR+2 LEAST SIGNIFICANT DIGITS. 

we 

*** BCD POSITION IN DEGREES. 

DEGRES RMB 4 

HUNDEG EQU  DEGRES CONTENTS X 100.000 

ONEDEG EQU —ODEGRES+1 CONTENTS X 1.000 

HUNDTH EQU DEGRES+2 CONTENTS X 0.010 

THOUTH EQU §- DEGRES*3. = + CONTENTS X 0.001 

Wwe ww www mmm ww ee wee eeecc en 

ene POSITION IN DEGREES 

ne 

*** BCD COUNT. 

BCDCT RMB 3 

TENTHO EQU BCDCT CONTENTS X 10,000 

HUNDRD QU BCDCT+1 CONTENTS X 100 

TENONE EQU BCDCT+2 + CONTENTS X 1 

Wee sti www mmm ewe eee ee ee eee ee oe 

wee NUMBER OF PULSES COUNTED 

rere 

*** HYSTERESIS COUNTER. POINTS TO A NUMBER IN THE TABLE THAT IS THE 

ane AMOUNT OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 7. 
HYSTPT RMB 1 

xf 

*** POSITION INCREMENT. CONTAINS A NUMBER, THAT WHEN MULTIPLIED BY 0.001 
=e IS THE NUMBER OF DEGREES THAT THE POSITION COUNTER (BCOPOS) IS 
wee TO BE INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 
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0022 


0023 
0024 


0025 
0026 


0027 


0000 
0080 


0080 


0080 
0081 


0082 
0084 
0085 
0086 
0088 


0080 


“ae THE VALUE OF ‘POSINC’, DETERMINED EXPERIMENTALLY, SHOULD BE 


ahaha 7.0312. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 
we THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 
we THE ROUND OFF, EVERY 32 COUNTS ‘POSINC’ IS SET EQUAL TO 8. THIS 
hala AGAIN LEADS TO SOME CUMULATIVE ERROR THAT IS ACCOUNTED FOR BY 
awe SETTING ‘POSINC’ TO 7 INSTEAD OF 8 WHEN THE COUNT REACHES A 

wee VALUE OF 16384 (2°14). 

tee 

POSINC RMB 1 

rere 

** HYSTERESIS VARIABLES. USED TO ELIMINATE THE EFFECTS OF BACKLASH ON 
ane THE POSITION MEASUREMENTS. 

att 

HYST RMB 1 THE THRESHHOLD VALUE DETERMINED 

wwe EXPERIMENTALLY. 

HYSTCT RMB 1 CURRENT AMOUNT OF HYSTERESIS MEASURED. 

rere 


*** STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING ON. 


wet 


STAT RMB 1 CURRENT STATUS. 
LSTAT RMB 1 PREVIOUS/LAST STATUS. USED TO KEEP TRACK OF 
we L_SET ONLY. 
xee 
*** TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 
siaia TDR TO KEEP TRACK OF ONE SEC. INTERVALS. USED IN BLINKING THE 
see DISPLAY. INITIALLY SET TO 31, WHEN THE ‘FLASH’ BIT OF ‘STAT! 
wee IS SET. TIMCT IS DECREMENTED EACH CLOCK INTERRUPT (APPROX. 31 
one TIMES PER SEC). RESET TO 31 WHEN CONTENTS GO TO ZERO. 
one WHEN (TIMCT)=0 THE DISPLAY WILL TOGGLE. 
kee 
TIMCT RMB 1 
&e 

ENDS 


ax 
Raw 
RRKRKAAARLCACKCAAKCRKKCRLCACAAAKACKCKCECCCACLEACAKEARACKKKCLAAKLALCARKKKKAKKCAAKKAKKAKKAKKKAKKKKE 


at 
ghd PAGE ZERO ROM 
xe & 


RARRCACAACRCKCAACARAAKCAKAACKAKAKLCCAKRCRKCKCCARCKCAKLCKAKARKRLKKLKAKKAKAAKRKAKAKKARKKKAXAER 
aw 

ae INITIALIZATION ROUTINE. 

eek 

ae 


CODE 


ae 


ORG ZROM PAGE ZERO ROM. 


ww 


RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE BRANCH. 
we 
RESTRT EQU 9 THIS IS THE ENTRY POINT WHEN THE RESET 
uae SWITCH IS PUSHED. 


ee 
RAKAAAKCRRAKAKERAKEKARERAAEAKEKKAKAKREKEKEAEAKAKKAAAKKEKKEKAEKEKEKKEERERE 
ke 


ane INITIALIZE THE PC AND CLEAR RAM. 
xzxw 
kane 
SEI SET INTERUPT TO AVOID INTERUPTION AND 
RSP RESET THE STACK POINTER. JUST IN CASE! 
kee 
LDX #BINCT CLEAR ALL OF THE VARIABLES BETWEEN 
CLRIT CLR X 'BINCT’ AND ‘TIMCT’ (INCLUSIVE) .NOTE 
INCX THAT THIS SETS THE COUNTER AND THE POS- 


CPX #TIMCT ITION TO ZERO. THIS MEANS THAT ROTATION 
BLS CLRIT SHOULD START IN AN INCREASING (CW) 


al 


008A 


0090 
OO9F 
00A1 


00A3 


OOAS 


OOA7 
OOA9 


OOAB 
OOAD 


OOAF 


TERS 


1c 


Aé 


B7 


Aé 


B7 


Aé 
B7 


Aé 
B7 


1D 


25 


ae; 


08 


21 


47 


09 


1F 
27 


OA 


4E 


ne DIRECTION FROM THE MOST CCW POSITION 
haha AFTER A RESET. 
eee 
ABSOLUTE BACK TO ABSOLUTE ADDRESSING. 
eek 
REACT AAAAAE CERES CEETAEEKE CAEL AAEAEE CAESAREA AKETE 
rex 
ee ESTABLISH 1/0 PORTS. 
rere 
LDA #1 PORTS A,B,C ARE CONFIGURED AS 
STA PORTA*DDR = ALL_- OUTPUT. PORT D IS ALL INPUT 
STA PORTB+DDR = SO THERE IS NO MASK TO SET. 
STA —- PORTC+DOR 


tw 
eee 


JSR OUTCT COUNT IS TO BE DISPLAYED INITIALLY. 


eer 
RAREST AEE EA REESE AETRERAARETEAAELAEAEAEAEEEEES 
see SET UP THE STATUS REGISTER. 
tee 
LOA - #%00001000—-- 
AND PORTD 
STA STAT -- 


|--> SET UP ‘L_SET’ BIT OF ‘STAT’. 


eae 
BSET MOD_32,STAT O IS MODULO 32. 

a 

EERE REE E EEA RRR EREEEEERERAEARAATAAEAAAERE EE AEA RE EEE ERE REE EE 

wee 


wae INITIALIZE HYSTCT. 
wee 

LDA #08 

STA HYST 

STA HYSTPT 


ree 
REMARK EEKAAEAEAKAAAAAAAARAAEAEAEKEAAAKTREKAAEEAAAEEAAAAAAEAKKEKEKEE 
te 


=~ SET UP THE TIMER FOR A 4 MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 
eek 
*** =NOTE: THE MASK OPTION REGISTER IS IN ROM. IT IS SET UP AT 
wan THE END OF THE PROGRAM. 
tae 
RHC EKEKEE SET UP THE TCR. pPaeESeERASAAAARASALALALL ASL AL ALS ES 
wee 
LDA #B1T6+BIT2+BIT1+BITO 
la (TIM) | (PS2)(PS1) (PSO) 


***(DISABLE INTERRUPT) |(PRESCALE BY 128) 


wae 
STA TCR 

eee 

eee 

we® SET-UP THE TIMER. 

Ree 
LDA #255 1 MHZ/(128*255) = 30.6 (APPROX. 31) 
STA TIMER 


ee 
RREKRARERKKHKKKE INITIALIZE THE TIMER COUNTER. PAS aASALSALARL ARS AL ALS SS SD 3 
rex 


LDA ¥31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 
STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT=62, etc. 


weer 
wae 
pSSRSESLALILLL IL eT ETS PEST SAC TL SRST TR TS EES AS ASSET TASES ARAL ALE LS LSS SS 
er 


bia: SET UP MISCELLANEOUS REGISTER. 


we 


BCLR B6,MR ENABLES THE SECOND INTERRUPT. 


G2 


ee es eee 


00B1 


O0B2 


00C0 
00C2 


00c4 
00C6 
00c8& 
OOCA 
oocc 
OOCE 
0000 


0002 
0004 
0006 
0008 
OODA 


OODC 
OODE 
OOED 


O0E2 
O0E3 
O0E5 


O0E? 
O0E9 
OOEB 
OOED 


OOEF 
OOF 4 
OOF4 


OOF6 
OOF9 
OOFC 
OOFF 
0101 


0104 


9A 


03 OB 


03 04 


25 
F6 
25 
F2 


rt 
ee 


CLI 


Rae 


RELATIVE 


rank 
ert 


REEERAEEECECEEEEEEEEEEEEECEREEEEEEEEEEEEEREEEEEAEEEKEEEEEEEEEEEEEEAAEAAEEE 


ee 


** WAIT LOOP. 


et 


PAUSE 
wt 


SBIT BSET 


ee 


KREREEAAKEKEEAREEEREAEEREAEEKEEEKEAREERAEEEEEEEEEHEREEEEEKEEREEEEEEEREEEEKE 


tk 


** HYSTERESIS MODIFICATION ROUTINE. 


BRCLR 


CLEAR THE INTERRUPT MASK TO GET STARTED. 


RELATIVE ADDRESSING MUST BE USED FOR THE 
REMAINDER OF THE PROGRAM. 


EXECUTES, UNTIL AN INTERRUPT OCCURS. 


FUNCT ,PORTO,CHHYST WANT TO CHANGE HYST? 
YES...GO TO CHHYST. 


SET,PORTD,SBIT NO... *SET,PORTD’ SET? 
L_SET,STAT NO...CLEAR ‘L_SET,STAT! 
PAUSE ANO LOOP. 

L_SET,STAT YES...SET ‘L_SET,STAT’ 
PAUSE AND... .LOOP 


PERMITS MODIFICATION OF THE 


** HYSTERESIS BUFFER WITHOUT REPROGRAMMING. 


xe 


CHHYST LDA 
STA 


trek 


LDA 
AND 


tke 


kre 


ere 


etek 


DOISPLA LOA 


Raa 


rk 


ake 


SHOPOS JSR 


Rae 


OUNCHG BRCLR 


#8116 
TCR 


#%00001000 
STAT 

LSTAT 
#%00001000 
PORTO 
LSTAT 
DISPLA 


#%00001000 
STAT 

STAT 

HYST 
HYSTPT 


HYSTPT 
#25 
DISPLA 


HYST 
HYSTPT 


#%00000000 
PORTA 
#%11000000 
PORTB 


HYSTPT 
TABLE , X 
PORTC 


FUNCT,PORTD,CHHYST NO... 
POSCT,STAT,SHOPOS YES... 


OUTCT 
DUNCHG 


OUTPOS 


FLASH, STAT,NO_INT 
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DISABLE TIMER INTERRUPT. 


SAVE ‘L_SET! 
INTO 
‘LSTAT’. 


‘SET, PORTD’ --> ACCUMULATOR 
HAS THE SET SWITCH BEEN CHANGED? 


ME S6 6c 


|-->CHANGE ‘L_SET,STAT’, 


THEN INCREMENT THE HYSTERESIS 
POINTER AND ‘HYST’... 


-- DISPLAY CURRENT ‘HYST’. 


IS *‘HYST’ SETTING COMPLETE? 
KEEP CHECKING ‘SET’. 
RESET THE DISPLAY. 


IF THE DISPLAY IS TO BLINK... 


0107 
0109 
0108 


0100 


O10F 
0112 
0115 


0117 
0119 
0118 


O11C 
O11E 
0121 
0122 
0124 
0126 
0128 


O12A 
0120 


O12E 


0131 


0133 
0135 


0137 


0138 
O13A 


A6 07 
B7 09 
20 AS 


012E 
OF 09 
1F 09 


3A 27 
27 01 


80 


A6é iF 
B7 27 


10 
07 


4E 


oc 


NO_INT 


ree 
Re 


LOA 
STA 
BRA 


#81T2+B1T1+B1TO 


PAUSE 


ENABLE TIMER INTERRUPT AND RESET 


TCR TIMER PRESCALER 


PRIOR TO RETURNING. 


RLAELAARAAEAAEREAERKECEEAEATEEARAAEEKARARAERAAREARETEEAEEEREERAEAEREKEEARERKEEEEKEEE 


** MAXIMUM EXECUTION TIME FOR THE REMAINDER OF THE PROGRAM OCCURS 

** IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE IS CHANGED 
** FROM THE BLINKING MODE TO THE COUNT MODE AT THE SAME TIME THAT THE 
** BLINKING ROUTINE IS CAUSING THE DISPLAY TO TOGGLE TO SHOW THE 

** POSITION IN DEGREES. 


MAXIMUM EXECUTION TIME = 140 + 184 + 708 = 1032 CLOCK CYCLES. 
eset ett tet teo ee fe siete tect i es oii t cece sere eri etecret ee te rca ee te reas 


rr 


tf 


** MODE CHANGE ROUTINE. 


we 


ee 


DISPOS 


ee 


ee 


CHANGES THE DISPLAY MODE FROM 


COUNT -> POSITION -> BLINKING -> COUNT ->....(ETC.) 

MAXIMUM EXECUTION TIME OF 181 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY MODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 
THE POSITION CIN DEGREES). 
IF THE DISPLAY IS CHANGED FROM BLINKING TO A COUNT DISPLAY 
EXECUTION TIME IS 140 CLOCK CYCLES. 


BCLR 


BRSET 
BRCLR 
BSET 


LDA 
STA 
RTI 


BSET 
JSR 
RTI 


LDA 
STA 
BCLR 
BCLR 


JSR 
RTI 


B7,MR AVOID REPEATED INTERRUPTS. 


FLASH, STAT,OIS CT IF 
POSCT,STAT,DISPOS IF 


FLASHING, DISPLAY COUNT... 
SHOWING COUNT, DISPLAY POSITION... 


FLASH, STAT ELSE, BLINK. 
#81T2+BIT1+BITO | ENABLE TIMER INTERRUPT AND RESET 
TCR TIMER PRESCALER. 
POSCT, STAT -- 
OUTPOS |-- DISPLAY CURRENT POSITION, AND WAIT. 
WBIT6+BITZ+BITI+BITO OISABLE TIMER INTERRUPT AND RESET 
TCR TIMER PRESCALER. 
POSCT, STAT -- 
FLASH, STAT | 

|-- DISPLAY CURRENT COUNT, AND WAIT. 
OUTCT 


PSR RSASLASELLLLASSLALE LAL EA SELES EL AA SALAS ALAA SALA SALE ARLALALLC LS eS SES SF 


** BLINK ROUTINE. 


we 


re 


ex 


CHGOIS 


kk 


INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 


TO COUNT OR VICE VERSA EVERY 31 ST TIMER INTERRUPT IF THE 


‘FLASH! 


BIT OF ‘STAT’ IS SET. 


MAXIMUM EXECUTION TIME OF 184 CLOCK CYCLES OCCURS WHEN THE 
DISPLAY IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 


EQU 


BRCLR 


BCLR 


DEC 
BEQ 


RTI 


LDA 
STA 


$ 
TIR, TCR, CHMODE 


TIR, TCR 


TIMCT 
CHGDIS 


#31 
TIMCT 
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IF THE INTERRUPT WAS NOT A TIMER 
INTERRUPT IT MUST BE FROM INT2. 


AVOID REPEATED TIMER INTERRUPTS. 
IF THERE HAVE BEEN 31 TIMER 
INTERRUPTS (1 SEC), IT’S TIME TO 
CHANGE THE DISPLAY. 

OTHERWISE, IT’S BACK TO WORK. 


RESET TIMCT TO 31 (1 SEC. INTERVAL). 


013C 
O13E 
0140 


0142 


0145 
0148 


0149 
014C 


0140 
0150 


0151 
0153 
0155 
0157 
0159 


0158 
015D 


O15F 
0162 
0164 


0166 
0168 


09 


LDA STAT = 
EOR #%00010000 |-- CHANGE ‘POSCT’ BIT OF ‘STAT’. 
STA STAT i 


ne 


BRSET POSCT,STAT,POSOUT DECIDE ON CORRECT DISPLAY. 


ee 


WEESRSWREAR® CHANGE THE) DISPLAY TO SHOW THE COUNT..... ‘“#***eeeRERENES 
we 

JSR OUTCT 

RTI 


et 


eekeekteeeeh OP HAVE THE DISPLAY SHOW THE POSITION, ‘SS*#eeenenaeeneeee 
we 
POSOUT JSR OUTPOS 

RTI 


we 
PERCE EKCEAERAERAR AERA AREKEAREEEAR RARE ARACEAE EKE 
ew 


=e COUNT ROUTINE. 

dd WHEN A COUNT IS RECEIVED THIS IS THE ENTRY POINT . 

me MAXIMUM EXECUTION TIME OF 708 CLOCK CYCLES OCCURS WHEN THE 

sha COUNTER ROTATES CCW THROUGH ZERO AND THE POSITION (IN DEGREES) 
bias IS BEING DISPLAYED. 


** CURRENT DIRECTION OF ROTATION IS DETERMINED BY INSPECTING THE STATUS 
** OF ‘CH_A’ AND ‘CHB’. THE FOUR POSSIBILITIES AND THE ASSOCIATED 

** DIRECTION OF ROTATION ARE AS SHOWN BELOW. NOTE THAT THIS SCHEME 

** PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 

** REPEATEDLY INCREMENTING OR DECREMENTING THE COUNTER. 


we Hone eecee Hore cecees Herre e ree ees cescces Here r rere ee eer cene- + 
** | CHA | CHB | DIRECTION | COUNT THE PULSE? | 
coe | | | OF ROTATION | | 
we tocccceee 2 He cece ence eee ecccee 0 et ee! 
‘* |e Lo | Cw | NO | 
so | Lom | HI | CCW | YES | 
a a ee CCW | NO | 
oh | ee | cw | YES | 
belied Hor eecece tooccccece torre eee ce es eeccece 0 + 


weeeeeee FIRST SEE IF WE ARE SUPPOSED TO COUNT THIS INTERUPT. ‘******** 
we 
COUNT EQU $ 

BRSET CH_B,PORTD,OKCT IF CH_B IS LO WE DON’T COUNT THE 

RTI INTERRUPT. 


x 


seeeeeeeweeeee TF THE INTERRUPT IS VALID UPDATE ‘STAT’, ‘**#aeeeeneene 


x* 


OKCT LDA #%01111111 


AND STAT SAVE ALL OF THE OLD ‘STAT’ EXCEPT THE 

STA STAT DIRECTION OF ROTATION. 

LDA #%10000000 

AND PORTD ‘CH_A,PORTD’ INDICATES THE DIRECTION 
sf OF ROTATION AND BECOMES ‘UD,STAT’. 

ORA STAT ADD THE RESULTS TO GET 

STA STAT THE NEW ‘STAT’. 


xe 


** DECIDE IF THE "SLACK" DUE TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT. 


ne 


BRSET UD,STAT,HYSTCK IF ROTATING CW SEE BELOW. 


LDA HYSTCT ELSE, SEE IF WE DECREMENT THIS TIME. 
BEQ CCw IF HYSTCT=0, GO TO THE COUNT DOWN 

pies ROUTINE. 
SUB #1 ELSE, DECREMENT THE HYSTERESIS COUNTER, 
STA HYSTCT 


oO 


016A 


0168 
016D 
O16F 
0171 
0173 


0174 
0176 
0178 


O17A 
017¢C 
O17E 


0180 
0182 
0184 


0174 


xe 


HYSTCK 


ee 
er 


RTI 


LDA 
CaP 
BEQ 
INC 
RTI 


HYST 
HYSTCT 
Cw 
HYSTCT 


AND WAIT FOR THE NEXT INTERRUPT. 


IF ROTATING CW.... 

AND HYST = HYSTCT .... 

COUNT THE PULSE . 

ELSE, INCREMENT THE HYSTERESIS COUNTER, 
ANDO WAIT FOR ANOTHER PULSE. 


RRERRERERRAREEEREEEEEREEEEEREEEEEEEERRAEE EEE CHEER AEAEEEEEEEEEE 


we 
aw 
ae 
CW EQU 
at 
rer 
etrrrrrerrrees 
tee 
LDA 
ADO 
STA 
eee 
LDA 
ADC 
STA 
wee 
LDA 
ADC 
STA 


eee 
eee 


RRA KKKKEEKEEEE 


are 
eee 
exe 
exe 
RKex 
eux 
an 


nKxK 


MOD 


eek 


NOT_32 


eee 
exe 


DIRCHK 


eee 
axe 


aeK 


CLOCKWISE ROUTINE. 


INCREMENT THE BINARY COUNTER (BINCT). ‘*##e#eeeeeteqnens 


LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 
#1 LOBIN = LOBIN + 1 ; CARRY -> C,CCR 


LOBIN 


MIDBIN 
#0 
MIDBIN 


HIBIN 
#0 
HIBIN 


ADD THE CARRY TO THE MIDOLE BYTE. 


ADD THE CARRY TO THE HIGH BYTE. 


CLR/SET MOO_32 APPROPRIATELY. ********S*S555 


THE FOLLOWING SEVERAL LINES OF CODE ARE PRETTY MESSY. ALL THAT 
IS BEING DONE IS TO ENSURE THAT THE SCALE FACTOR IS SET PROPERLY. 
FOR THE PAN AXIS THE SCALE FACTOR IS; 


LDA 
AND 
BNE 
LDA 
BEQ 
AND 
BNE 
BRCLR 


BSET 
BRA 


BCLR 


LDA 
BM! 


BNE 
LDA 
BNE 
LDA 
BNE 


BCLR 


1 PULSE => 0.007097 DEGREES 


LOBIN 
#%00011111 
NOT_32 
MIDBIN 
MOD 
#%00111111 
MOO 


IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 


ZERO THEN THE NUMBER ISN‘T A MOOULO 32 NUMBER. 


IF THE LOW SIX BITS OF ‘MIDBIN’ ARE ZERO 
AND ‘HIBIN’ .WE. ZERO 

THEN THE NUMBER IS MOOULO 16,384, AND WE 
DON’T WANT TO SET ‘MOO_32,STAT’, UNLESS 


B6,MIDBIN,NOT_32 THE NUMBER IS ALSO MOOULO 32,768. 


MOD_32,STAT 
DIRCHK 


MOD_32,STAT 


HIBIN 
CWNEG 


CwPOS 
MIDBIN 
CwPOS 
LOBIN 
CwPOS 


NEGTIV, STAT 


96 


IF HIBIN < 0 , WE’RE ROTATING CCW TOWARD 
THE ORIGIN. 


ELSE IF BINCT .NE. O 
WE'RE ROTATING CW 
AWAY FROM THE ORIGIN. 


ELSE, WE’VE ROTATED CW THROUGH THE ORIGIN. 
CLR NEGATIVE SIGN. 


O1AD 
O1AF 
0180 
01B1 
0183 
0185 


0187 
0189 
O01BC 


O1BE 
01C1 
0104 


01C6 
01C8 
O1CA 
Oicc 
O1CE 
0100 
01D2 
0104 


0107 
0109 


0108 


0100 
O1DF 
O1E1 


O1E3 
O1E5 
O1E7 


O1E9 
O1EB 
O1ED 


O1EF 
O1F 1 


O1F3 
O1F5 
O1F7 
O1F9 
O1FB 


01C6 


04 


CLRIT2 CLR x -- 
INCX --RESET ALL COUNTERS AND DEGRES TO ZERO. 


BRA UPOUT UPDATE OUTPUT. 
kee 
CWPOS BSR ADDBCD 

JSR INCPOS 

BRA UPOUT 


eke 

et 

REAR AR AAEEEE KEE EEREEEAEEEEAEEEEEEAEEEEEHEREEEEREEEEAEEEKERRERERAEE 
ee 


o* COUNTER-CLOCKWISE ROUTINE. 
wo 


CCw EQU 3 

«x 

eae 

REKKKKKKKKKKKKKKEE CLR/SET MOD 32 APPROPRIATELY. RAEKEKAKAKKEKKKKKKKKKK 


wrk 


ee AGAIN SET THE SCALE FACTOR TO; 

eke 

ee 1 PULSE => 0.007097 DEGREES 

eke 
LDA LOBIN IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 
AND #%00011111 ZERO THEN THE NUMBER ISN’T A MODULO 32 NUMBER. 
BNE NO_32 
LDA MIDBIN IF THE LOW SIX BITS OF ‘MIDBIN’ ARE ZERO 
BEQ MODLO AND ‘HIBIN! .NE. ZERO 
AND #700111111 THEN THE NUMBER IS MODULO 16,384, AND WE 
BNE MODLO DON’T WANT TO SET ‘MOD_32,STAT’, UNLESS 


BRCLR B6,MIDBIN,NO_32 THE NUMBER IS ALSO MODULO 32, 768. 
Rx 
MODLO BSET MOD_32,STAT 
BRA DECBIN 
krk 
NO.32 BCLR  MO0_32,STAT 
eke 
kx 
RXKKEKKKKKKKKKKE DECREMENT THE BINARY COUNTER (BINCT). RKXKKEKEKKKKKKKKKEK 
eke 
DECBIN LDA LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 
SUB #1 LOBIN = LOBIN - 1 ; BORROW -> C,CCR 
STA LOBIN 
kek 
LDA MIDBIN 
SBC #0 SUBTRACT THE CARRY FROM THE MIDDLE BYTE. 
STA MIDBIN 


eek 


LOA HIBIN 

SBC #0 SUBTRACT THE CARRY FROM THE HIGH BYTE. 

STA HIBIN 
it 

LOA HIBIN 

BPL CCwPOS IF HIBIN .GE. 0 , WE'RE ROTATING CCW TOWARD 
aa THE ORIGIN. 

LOA #-1 “5 

CMP HIBIN = 

BNE CCWNEG “eecUSE [fF BINCT .NE.. -1 ; 

CMP MIOBIN -- WE'RE ROTATING CCW AWAY 

BNE CCWNEG -- FROM THE ORIGIN. 


o7 


O1FD 
O1FF 


0201 


0203 
0205 
0207 
0209 
0208 
0200 
O20F 
0210 
0211 
0213 


0215 
0217 
O21A 


021C 
O21F 


0222 


0225 
0228 


0229 
022C 


022D 
022F 
0231 
0233 
0235 
0237 
0238 


023A 
0238 
023D 


O23E 
0241 
0243 


0245 
0247 
0249 
024B 


FD 


CA 
FD 


04 


4E 


BE 


CMP LOBIN =< 
BNE CCWNEG -- 


BSET NEGTIV,STAT ELSE, WE’VE GONE THROUGH ORIGIN IN CCW 


bit DIRECTION. SET NEGATIVE SIGN. 
al AND SET ALL COUNTERS APPROPRIATELY. 
LDA #03 = 
STA PTR4 << 
STA HUNDEG -- DEGRES = 360.00 
LDA #60 
STA PTR3 ei 
LDX WPTR2 = -- 
CLREM CLR X Be 
INCX -- EVERYTHING ELSE IS ZERO BEFORE CHANGE. 
CPX #CTPTR1 Te 
BLS CLREM -- 


Ree 


CCWNEG BSR ADOBCD 
JSR DECPOS 


BRA UPOUT 
wee 
CCWPOS JSR SUBBCD 
JSR DECPOS 


kkk 

kine 

xe 

RECA KEKCEEKEKCKEEKEEETERZEKEEKCEEKEKEEEKCEEKEEEEAAAEKRAEKEKEEEEKEKEKEEK 
ee 


** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 
al CALLING THE APPROPRIATE SUBROUTINE.(’OUTCT’ TO OUTPUT THE 
bl THE COUNT AND ‘OUTPOS’ TO OUTPUT THE POSITION). 


UPOUT EQU $ 


x 


BRCLR POSCT,STAT,PUTCT 


ee 


JSR OUTPOS 
RTI 

ee 

PUTCT JSR OUTCT 
RTI 


ee 
HRREKKLACCECEKEKATEKEEKKCEACKEEKEEECEEERAEKEAEKEAEEEKEAEEREREKKEERREKEKKEKEREKKKEK 


weeekeeeeee SUBROUTINE TO INCREMENT THE BCD COUNTER (BCDCT). ********* 


kink 


ADDBCD LDA CTPTR1 


ADD #1 
CMP #99 CTPTR > 99 ? 
BLS OK 1 NO, WE’RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
SUB #100 YES... MODIFY THE CTPTR, 
SEC SET THE CARRY, AND 
BRA OKIA USE TABLE LOOK UP. 
kx 
OK 1 ELEC NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK1A STA CTPTR1 -- 
TAX ee 
oe -- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X -- 
STA TENONE -- 
BCC NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 
eee 
eae 
LDA CTPTR2 
ADC #0 ADD THE CARRY. 
CMP #99 CTPTR > 99 ? 
BLS OK2 NO, WE’RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 


98 


77% 


eJd3g9 


EE os 


0240 
O24F 
0250 


0252 
0253 
0255 


0256 
0259 
0258 


0250 
O25F 
0261 
0263 


0264 
0267 


0269 


20 


A6 


BE 


BE 


04 


BE 


SUB #100 YES... MODIFY THE CTPTR, 
SEC SET THE CARRY, AND 
BRA OK2A USE TABLE LOOK UP. 


eXek 


OK2 CLC WO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK2A STA CTPTR2 -- 

TAX =e 
+o -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


BCC NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 
kit 

LDA CTPTR3 

ADC © ADD THE CARRY. 

STA CTPTR3 -- 

TAX = 
we -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


LDA TABLE,X -- 
STA TENTHO -- 
Rkre 
NOMO —s- RTS 
eae 
REE EEACEAEAAEEAAEKEAAAEKAAEKEAEAAARKEAREEKEEKEEKERKEKERAEEKENEKEAEEEEEEEKEEK 
*eexe#e SUBROUTINE TO INCREMENT THE POSITION COUNTER (DEGRES). ******* 
week 
**e* FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 
anes NUMBER. 


rkknk 


INCPOS BRCLR MOD 32,STAT,INC7 ‘MOD_32,STAT’ SET ? 


keke 


LDA #8 WES “ee. 

BRA INC INCREMENT THE POSITION BY 0.008 DEGREES. 
keke 
INC7 LDA #7 NO .... 


INC STA POSINC INCREMENT THE POSITION BY 0.007 DEGREES. 


reksk 
**** ROUTINE TO INCREMENT THE POSITION COUNTER ,’DEGREES’,BY A 
i ohabal PREDETERMINED AMOUNT, ‘’POSINC’. 


reeks 


LDA PTR1 
ADD POSINC 
CMP #9 PTRI>9 ? 


BLS OK3 NO, WE’RE OK HERE. LOOK UP THE FIRST DIGIT. 
SUB #10 YES... MODIFY THE CTPTR, 

SEC SET THE CARRY, AND 

BRA OK3A USE TABLE LOOK UP. 


kkk 


OK3 CLC NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK3A STA PTR1 =. 

TAX ss 
liad -- LOOK UP THE LEAST SIGNIFICANT DIGIT. 


LDA TABLE,X -- 
STA THOUTH -- 


BCC DONE AND CONTINUE ONLY IF THERE WAS A CARRY. 
ween 
kkkk 

LDA PTR2 

ADC #0 ADD THE CARRY. 


CMP #99 PTR2 > 99 ? 
BLS OK4 NO, WE’RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
SUB #100  YES...MODIFY THE CTPTR, 
SEC SET THE CARRY, 
BRA OK4A AND USE TABLE LOOK UP. 
Keke 
OK4 CLC NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK4A ss STA PTR2 = -- 


a9 


0290 


O29E 
O2A1 
02A3 


O2A5 
02A7 
O2A9 
O2AB 
O2AD 
O2AF 
0280 


02B2 
0283 
02B5 


0286 
02B9 
02BB 


0280 
O2BF 
02C1 
02C3 


02C4 
02C7 


02c9 


O2CA 
O2cc 
O2CE 
0200 
02D2 


02D3 
02D5 


02D6 
02D9 
O02DB 


0200 
02D F 
02E1 
02E3 
O2E5 


O2E6 
O2E8 


O2E9 
O2EC 
O2EE 


O2F0 
O2F2 


BE 


BE 


BE 


BE 


Rae 


eee 
rete 


Rent 


rraek 


reek 
DONE RTS 
eee 
w% 


PTR3 


TABLE, X 
ONEDEG 
DONE 


PTRS 
#0 
PTR4 


TABLE ,X 
HUNDEG 


-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


ADO THE CARRY. 

PTR3 > 9 ? 

WO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
YES... MODIFY THE CTPTR, 

SET THE CARRY, AND 

USE TABLE LOOK UP. 


WO CARRY EXISTS IF WE ENTER AT THIS POINT. 


-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


ADD THE CARRY. 


-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


RARAEAECAACCAECETCCCKCTACTAAEACAAEAACAATAAATCAACAAKCACAAKACAAATACAAKCKCACKCECARAEKKCKEAEAAEEKE 


seeeeets SUBROUTINE TO DECREMENT THE BCD COUNTER (BCDCT). ******8eeex8 


eek 


SUBBCD LDA 


OK6 STA 


art 


OK7 STA 


aee 


aet 


CTPTR1 


CTPTR1 


TABLE ,X 
TENONE 
COMPLT 


CTPTR2 
#0 
OK7 
#100 


CTPTR2 


TABLE ,X 
HUNDRD 
COMPLT 


CTPTRS 
#0 


100 


CTPTR > 99 ? 

NO, WE'RE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
YES, MODIFY THE CTPTR, AND 

GENERATE A BORROW. 


-- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 


AND CONTINUE ONLY IF THERE WAS A BORROW. 


SUBTRACT THE CARRY. CTPTR > 99 ? 

NO, WE’RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
YES, MODIFY THE CTPTR, AND 

GENERATE A BORROW. 


-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


AND CONTINUE ONLY IF THERE WAS A CARRY. 


SUBTRACT THE BORROW. 


O2F4 
O2F6 


O2F7 
O2FA 


O2FC 


O2FD 


0300 
0302 


0304 
0306 


0308 
030A 
030C 
030€ 
0310 


0311 
0313 


0314 
0317 
0319 


031B 
031D 
031F 
0321 
0323 


0324 
0326 


0327 
O32A 
032c 


032E 
0330 
0332 
0334 
0336 


0337 
0339 


033A 
033D 
O33F 


B7 17 
97 


Dé 03 
B7 1£ 


81 


20 02 
A6 07 


BE 


BE 


BE 


BE 


STAs CTPTR3.-- 
TAX -- 
“ne -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA —s-‘TABLE,X => 
STA —s*‘TENTHO -- 
kak 
COMPLT RTS 
kirk 
RERAKAARAARARAEARRERAEERARERERERREARREEEEEEREEE REAR EREREREREREREEERREEAEKRRERERKREE 
eeeeeee SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). ******* 
teen 
**ee FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MODULO 32 
tees = NUMBER. 


trek 
DECPOS BRCLR MOO _32,STAT,DEC7 "MOD_32,STAT’ SET ? 
reen 

LDA 8 YES... 

BRA DEC DECREMENT THE POSITION BY 0.008 DEGREES. 
Raakk 
DEC? LDA #7 NGL... 


DEC STA POS INC DECREMENT THE POSITION BY 0.007 DEGREES. 


rhkt 
wee* ROUTINE TO DECREMENT THE POSITION COUNTER ,’DEGREES’,BY A 
een PREDETERMINED AMOUNT, ‘POSINC’. 


Rkrkk 


SUB POSINC PTR1 < 0 ? 
BCC oK8 NO, WE’RE OK HERE. LOOK UP THE FIRST DIGIT. 
ADD #10 YES, MODIFY THE CTPTR, AND 


SEC GENERATE A BORROW. 
akak 
OK8 STA PTR1 == 

TAX -- 
sees -- LOOK UP THE LEAST SIGNIFICANT DIGIT. 


LDA TABLE,X -- 
STA THOUTH -- 


BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A BORROW. 
kak 
kere 

LDA PTR2 

SBC #0 SUBTRACT THE BORROW. PTR2 < 0 ? 


BCC OK9 NO, WE’RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, AND 


SEC GENERATE A BORROW. 
kre 
OK9 STA PTR2-- 

TAX -- 
ane -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


LDA TABLE,X -- 
STA HUNDTH -- 


BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 
kan 
aa* 
LDA PTR3 
SBC #0 SUBTRACT THE BORROW. PTR3 < 0 ? 
BCC OK10 NO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, AND 
SEC GENERATE A BORROW. 
akexk 
OK10 STA PTR3-- 
TAX -- 
tees -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


LDA TABLE,X -- 
STA ONEDEG -- 
BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 


akan 


101 


0341 
0343 
0345 
0347 


0348 
0348 


0340 


O34E 
0350 


0352 
0354 


0356 
0358 


035A 
Q35C 


O35E 
0361 
0363 
0365 


0367 


Bé 13 
A2 00 
B7 13 
97 


Dé 03 
B7 1A 


81 


1D 01 


81 


A6é 00 
B7 02 


BE 


LDA 
SBC 
STA 
TAX 
teak 
LDA 
STA 
rkee 
DUNSUB RTS 
wee 
ate 
an 


PTR4 


#0 SUBTRACT THE BORROW. 
PTRG es 
-- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
TABLE,X = 
HUNDEG -- 


RERRAAAAEAKECEK EACLE LAKERS 


ke 


** OUTPUT COUNT (OUTCT). 


SUBROUTINE TO MOVE THE CURRENT COUNT (BCOCT) 


we TO THE OUTPUT PORTS. REMOVES THE DECIMAL POINT FROM THE 
dal DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 
+e SETS THE MINUS SIGN IF APPROPRIATE. 
re 
OUTCT EQU $ 
gre 
LDA TENONE 
STA PORTC 
xx 
LDA HUNDRD 
STA PORTA 
“xX 
LDA TENTHO 
STA PORTB 
xX 
BSET  DECPT,PORTB 
BCLR BLANK, PORTB 
xx 
BRSET NEGTIV,STAT,MINUS 
BSET  POSTIV,PORTB 
BRA ALLDUN 
xx 
MINUS BCLR  POSTIV,PORTB 
kx 
ALLDUN RTS 


xx 
ke 


** OUTPUT POSITION (OQUTPOS). 


SUBROUTINE TO MOVE THE CURRENT POSITION 


eis COUNT (BCDCT) TO THE OUTPUT PORTS. THE DECIMAL POINT IS 
alt DISPLAYED , AND ONLY THE MOST SIGNIFICANT DIGIT IS BLANKED. 
eh 
OUTPOS EQU $ 
at 
LDA THOUTH -- 
CMP #5 
BLO TRUNC == IF 5 > ‘THOUTH’ SIMPLY TRUNCATE THE 
LDA HUNDTH -- DISPLAY. OTHERWISE... 
AND #9 -- IF THE LAST DIGIT ISN’T A WINE IT IS 
CMP #9 -- EASY TO ROUND UP. JUST ADD A OWE. 
BNE DECIMAL =" 
LDA HUNDTH ~- BUT IF THE LAST DIGIT IS A NINE CHECK TO 
CMP #899 -- SEE IF IT’S 99. IF SO IT GETSSGRERE 
BEQ UGLY ae 
ADD #7 -- IF THE NUMBER IS X9 AND X .NE. 9, THEN 
BRA PCOUT -- JUST ADD SEVEN TO ROUND UP. DUE TO 
da -- HEXIDECIMAL. 
Lt -- IF THE LOW TWO DIGITS ARE BOTH NINES 
UGLY LDA #00 -- AND WE NEED TO ROUND UP.... 
STA PORTC oe MAKE THE LOW TWO DIGITS BOTH ZEROS 
SEC a AND SET THE CARRY. 
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986 0385 B86 1B LDA ONEDEG -- CHECK THE LAST DIGIT AS BEFORE. 


987 0387 A4 09 AND #9 = IF USING THIS PORTION OF THE CODE 

988 0389 Ai 09 CaP #9 -- THERE HAD TO BE A CARRY. 

989 0388 26 IE BNE NEXT -- IF THE LAST DIGIT IS NOT A NINE USE THE 
990 038 Bé6 1B LDA ONEDEG -- ADC INSTRUCTION BELOW. 

991 O38F Al 9 CaP #399 -- IF IT IS A NINE, IS THE NEXT ONE A NINE 
992 0391 27 04 BEQ RLUGLY -- ALSO? 

993 0393 AB 07 ADD #7 =< IF NOT JUST ADD SEVEN, 

994 0395 20 18 BRA PAOUT os AND DISPLAY THE OUTPUT. 

995 we 

996 0397 A6 00 RLUGLY LDA #00 aad 

997 0399 87 00 STA PORTA ae IF SO ROUND UP THE MOST SIGNIFICANT 
9968 03983 99 SEC we DIGIT AND SET EVERYTHING ELSE TO ZERO. 
999 039C 20 13 BRA NEXT 1 7 

1000 we 

1001 O39€ B86 IC DECIMAL LDA HUNDOTH -- 

1002 O35A0 AB 01 ADD #1 == 

1003 ba -- THIS IS ALL THAT NEEDS TO BE DONE IF 
1004 O3A2 8B7 02 STA PORTC =< THE LAST DIGIT IS NOT A NINE. 

1005 O3A4 20 05 BRA NEXT == 

1006 we 

1007 O3A6 B86 1C TRUNC LDA HUNDTH -- 

1008 O3A8 8B? 02 PCOUT STA PORTC -- ANDO IF THERE IS NO CARRY IT’S EVEN EASIER. 
1009 O3AA 98 CLC 2° 

1010 “2 

1011 O3AB B6 1B NEXT LDA ONEDEG 

1012 O3AD A9 00 ADC #0 

1013 O3AF B87 00 PAOUT STA PORTA 

1014 gh! 

1015 0381 B6 1A NEXT1 LDA HUNDEG 
1016 0383 AY 00 ADC #0 
1017 0385 B7 01 STA PORTB 
1018 ais 
1019 O3B7 1c 01 BSET POSTIV,PORTB 
1020 0389 18 01 BSET BLANK, PORTB 

1021 O3BB iF 01 BCLR DECPT,PORTB 

1022 hal 

1023 O38D 81 RTS 

1024 vie 

1025 ga 

1026 RRARAAARARAARRRARARAKRARRARARARARAERARAKRARRAARMRRAARRAARRAARAKRHAARKHAAKAKKAHAAAHH 
1027 ae 

1028 ** SET UP THE TABLE TO BE USED WITH BCD INCREMENT/DECREMENT ROUTINES. 
1029 “ 

1030 . ENOS 

1031 . DATA 


1032 O3BE 0001 02 03 04 TABLE FCB $00, $01, $02, $03, $04, $05 ,$06, $07, $08, $09 


1033 03C8 1011 12 13 14 FCB $10,$11,$12,$13,$14,$15,$16,$17,$18,$19 
O3cD 15 16 17 18 19 

1034 0302 20 21 22 23 24 FCB $20 ,$21,$22,$23,$24,$25,$26,$27, $28, $29 
0307 25 26 27 28 29 

1035 O030C 30 31 32 33 34 FCB $30, $31, $32,833, $34, $35, $36,$37, $38, $39 
O3E1 35 36 37 38 39 

1036 O3E6 40 41 42 43 44 FCB $40, $41,$42,$43,$44,$45 $46, $47,848, $49 
O3EB 45 46 47 48 49 

1037 O3FO 5051 52 53 54 FCB $50,$51,$52,$53,$54,$55, $56, $57, $58, $59 
O3F5 55 5657 58 59 

1038 O3FA 60 61 62 63 64 FCB $60, $61, $62, $63, $64, $65, $66, $67, $68, $69 
O3FF 65 66 67 68 69 

1039 0404 7071 72 73 7 FCB $70 ,$71,$72,$73,$74, $75 ,$76,$77, $78, $79 
0409 75 76 77 78 79 

1040 040E 80 81 82 83 84 FCB $80, $81, $82, $83, $84, $85, $86,$87, $88, $89 
0413 85 86 87 88 89 

1041 0418 9091 92 93 9% FCB $90, $91, $92,$93,$94,$95,$96,$97, $98, $99 
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0422 


OF38 
OF38 


OFF8 


OFF8 
OFFA 
OFFC 
OFFE 


1000 


Lines Assembled : 


07 


012E 
0140 
014D 
0080 


* 
* 


ENDS 
CODE 


RAERAARAAAETRERRAAAEAEERAEAEEREEREKERREEEEEREREEAKEREAEEREEREAAHEAEREAEEEEE 


ke 
wv 
kk 


ae 
bad 


kk 


ae 


ke 
ke 
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SET UP MASK OPTION REGISTER. 


ABSOLUTE 

ORG OR 

FCB #81 T2+B1T1+B1TO 

COMMENTS: 

BIT 7 CLOCK SOURCE O = CRYSTAL. 

BIT 6 TIMER OPTION O = INTERNAL. 

BIT 5 TIMER/CLOCK SOURCE O = INTERNAL. 
BIT 4 WOT USED. 

BIT 3 NOT USED. 

BIT 2 SET - 

BIT 1 SET - PRESCALE SELECT 111 => 128 
BIT 0 SET - 


ORG 


FDB 
FDB 
FDB 
FDB 


ENDS 
END 


ASSIGN INTERRUPT VECTORS. 
INTRPT 
BLINK TIMER/INT2 INTERRUPT VECTOR. 
COUNT EXTERNAL INTERRUPT VECTOR. 


COUNT SOFTWARE INTERRUPT VECTOR, NOT USED. 
RESTRT RESET VECTOR. 


Assembly Errors : 0 
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C. 


OOnN OU E Why = 


TILT 


0000 
0001 
0002 
0003 


0004 


TTL 


*® PROGRAM DESCRIPTION 


POSITION DETERMINING PROGRAM (ELEVATION) 
LATEST REVISION 9 MAY 89 
FILE NAME TILT.ASM 


** 1/0 REGISTER ADDRESSES 


ef 


PORTA EQU 
PORTB EQU 
PORTC EQU 
PORTD EQU 
ae 


$0000 
$0001 
$0002 
$0003 


I/O PORT A 
[/O PORT B 
1/0 PORT C 
INPUT PORT D 


** DATA DIRECTION REGISTER OFFSET 


ae 


DDR —- EU 
tt 

** OTHERS 
hk 

TIMER  EQU 
TCR = EQU 
MR EQU 
RAM = EQU 
ZROM = EQU 
ROM = EQU 
MOR EQU 
INTRPT EQU 
MEMSIZ EQU 
ae 

** EQUATES 
et 

BITO QU 
BIT!  EQU 
BIT2 EU 
BIT3  EQU 
BIT4  EQU 
BIT5 EQU 
BIT6 © EQU 
BIT7  — EQU 
ae 

B0 EQU 
Bt EQU 
Be EQU 
B3 EQU 
B4 EQU 
B5 EQU 
B6 EQU 
B7 EQU 


4 


NOUR WN =O a. eee +N 
= nN oO 


(eg. DDR FOR PORT A IS PORTA+DDR ) 


EIGHT BIT TIMER REGISTER. 

TIMER CONTROL REGISTER. 

MISCELLANEOUS REGISTER. 

START OF ON-CHIP RAM(112 - 31 FOR STACK) 
PAGE ZERO OF ROM. 

START OF MAIN ROM. 

MASK OPTION REGISTER. 

LOCATION OF INTERRUPT VECTORS. 

MEMORY ADDRESS SIZE. 


** EQUATES FOR THE TIMER CONTROL REGISTER 


TIR EQU 
TIM EQU 
TIN EQU 
TEE EQU 
PSC EQU 
PS2 EQU 
PSi EQU 


—= AIW & VIO ~ 


EOS 


TIMER INTERRUPT REQUEST. 1 = REQUEST, O = NO REQ. 
TIMER INTERRUPT MASK. 1 = DISABLED, O = ENABLED. 
EXTERNAL OR INTERNAL CLOCK SOURCE. 1 = EXT, O = INT. 


EXTERNAL CLOCK ENABLE. NOT USED. 
PRESCALER CLEAR. NOT USED. 

(PS2)R:- 

(PS1) [-- PRESCALER SELECT BITS. 


SBUEARRERSSISANRARATNTASRIIALALR 
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0000 


0007 
0006 


0004 


0007 
0006 
0005 
0004 


PSO EQU 0 (PSO) -- 


ee 


** EQUATES FOR THE STATUS BYTE, ‘STAT’. 


Rare 


eek 
we 

UD EQU 7 COUNT DIRECTION? 1 = UP, O = DOW. 

MOO_32 EQU 6 IS ‘BINCT’ MODULO 32? 1 = YES, O = NO. 

FLASH EQU 5 BLINK THE DISPLAY? 1 = YES, O = NO. 

POSCT EQU 6 DISPLAY POSITION OR COUNT? 1 = POS, O = COUNT. 
L_SET EQU 3 VALUE OF ‘MODE,PORTD’ LAST TIME. 

NWEGTIV EQU 2 IS ‘BCOCT‘’NEGATIVE NUMBER? 1 = YES, O = NO. 

‘aliafad 1 WOT USED. 

Ala 0 WOT USED. 

ter 

wae 

** 1/0 EQUATES AND DESCRIPTIONS. 

reer 

eee 

wen PORT A (1/0) 

tat 

blialiad teececee tocccece teecccce teeccces teoeccees tooceees teccceas teeccees + 
me | BCD DIGIT #4 | BCD DIGIT #3 
eee teeccece teercece trececece teereccee Hocccece toccceee Se teoeccee- + 
vida |} D4 | Ce | Bo | AS | O13 | C3 Jf BB | AD | 
wae toeecere- $------- teeecees tocreeeee teeceeee teececes Ho ewcece tooeccces + 
*** BIT 7 6 5 4 3 2 1 0 

Ree 

reek 

= PORT B (1/0) 

ree 

wae toocceee pocrcceee poccceee pocccece $rocecee- toocceee- t--ocece- toeccee- + 
eu | DISPLAY CONTROL NOT USED | 
wan tere ee-- toocence- tooeee-- teereee- toocceee teocccces teoccecee tococcrecce + 
wae | DECPT | POSTIV| | BLANK | | | | | 
wan teo------ toocene- to-ceceee tonceee- tooeecre- toocercee tooccece toeccece- + 
wee BIT 7 6 5 & 3 2 1 0 

xen 

DECPT EQU if TO DISPLAY THE DECIMAL POINT...DECPT IS CLEARED 
POSTIV EQU 6 USED TO DISPLAY NEGATIVE SIGN...CLEARED TO SKOW 
eciiates MINUS SIGN. 

BLANK EQU 4 TO BLANK DIGITS 2 AND 3...CLEAR BLANK. 

alin! DIGITS 4 AND 5 ARE ALWAYS BLANKED. 

lid DIGIT 1 IS NEVER BLANKED. 

rink 

oe PORT C (1/0) 

wee 

wae $------- +------- Hoocceee +o-eeeee +--e---- tocecces teeeccee tecceces + 
hole | BCD DIGIT #2 [BCD DIGIT #1(LEAST SIGNIFICANT) | 
wen to------ toeeece- teocece- tore e- torre -- Hoocccee teooccece teorcce- + 
ae } o2 | c2 | Be | a2 f| Of | Cl | BY 
wae toeren-- Hoocen--- to------ teoeceee- toon ee- toeeeeee Heer ecee- toccee- + 
See Bie re 6 5 “ 5 2 1 0 

are 

eee 

=e PORT D (CINPUT ONLY) 

rk 

wen Hoc ccee- tooccee- teerece- toccceee- torre e-e- toocee-- +------- teoo-ee- + 
=29 | CHA | INT2 {| CK_B | FUNCT | SET | | | 
wan tee eee torre e-e i tocceces toocecee torcece- i +oe-e-- + 
oe BLT if 6 > * 3 2 1 0 

Loe ij 

Ch_A EQU 7é INDICATES THE STATUS OF CHANNEL A. 

INT2 EQU 6 INTERRUPT #2. USED TO CHANGE DISPLAY MODES. 

CH B EQU 5 INDICATES THE STATUS OF CHANNEL B. 

FUNCT  EQU * USED TO PUT THE PROGRAM IN A MODE THAT WILL ALLOW 
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0000 


0000 


0010 


0010 


0012 


0015 


0017 


001A 


001C 


0003 


0010 
0011 


0012 
0013 
0014 


0015 
0016 


0017 
0018 
0019 


OO1A 
0018 


+28 ‘HYST’ TO BE INCREMENTED. 
SET EQU = INCREMENTS ‘HYST’ WHEN TOGGLED AND FUNCT IS LOW. 


eee 
eee 
REAR AEAAAEEAEEEE EERE EEE EEE AERA 


re * 
* RAM VARIABLES * 
hk * 
RARER AAEEEEEEEARAREREREARERREEEEEEREEAEERECEREEEEEEEEEEEEEAEREEEEAEEEEEE 
we 

** RESERVE MEMORY SPACE FOR THE PROGRAM VARIABLES. 

xe 


DATA 


ABSOLUTE (ABSOLUTE ADDRESSING USED HERE TO RELATIVE DIRECTIVE) 


ORG RAM START OF RAM. 
wt 
*** BINARY COUNT. 
BINCT RMB 2 
HIBIN EQU BINCT HI BYTE. 
LOBIN EQU BINCT+1 LO BYTE. 


xt 


*** POSITION POINTERS. 


PTR RMB 3 EACH BYTE POINTS TO A POSITION IN THE 
aha TABLE THAT CONTAINS ONE OR TWO DIGITS 
** OF THE BCD POSITION. 

PTR3 —- EQU PTR MOST SIGNIFICANT DIGITS. 

PTR2 EQU PTR+1 

PTR1 — EQU PTR+2 LEAST SIGNIFICANT DIGIT. 

we 

*#* COUNT POINTERS. 

CTPTR RMB 2 EACH BYTE POINTS TO A POSITION IN THE 
he TABLE THAT CONTAINS TWO OF THE DIGITS 
“s IN THE BCD COUNT. 


CTPTR2 EQU CTPTR MOST SIGNIFICANT DIGITS. 
CTPTR1 EQU CTPTR+1 LEAST SIGNIFICANT DIGITS. 
wt 


*** BCD POSITION IN DEGREES. 

DEGRES RMB 3 

ONEDEG EQU DEGRES CONTENTS X 14.000 
HUNOTH EQU DEGRES+14 CONTENTS X 0.010 
THOUTH EQU DEGRES+2 + CONTENTS X 0.001 


We we eww we ewes cece esccce 


wee POSITION IN DEGREES 
we 

*** BCD COUNT. 

BCOCT RMB 2 


HUNDRD EQU BCDCT CONTENTS X 100 

TENONE QU BCDCT+1 + CONTENTS X 1 

CM OOO OOOH OOO OOOO ooOUooS 

0s NUMBER OF PULSES COUNTED 

rex 

*** HYSTERESIS COUNTER. POINTS TO A NUMBER IN THE TABLE THAT IS THE 

wee AMOUNT OF HYSTERESIS PRESENT IN THE SYSTEM. INITIALIZED TO 6. 
HYSTPT RMB 1 

rer 

*** POSITION INCREMENT. CONTAINS A NUMBER, THAT WHEN MULTIPLIED BY 0.001 
alale IS THE NUMBER OF DEGREES THAT THE POSITION COUNTER (BCDPOS) IS 
lade TO BE INCREMENTED OR DECREMENTED DURING PROGRAM EXECUTION. 

lala THE VALUE OF ‘POSINC’, DETERMINED EXPERIMENTALLY, SHOULD BE 

nee 7.0452. SINCE THE PROGRAM IS DESIGNED WORK WITH INTEGERS ONLY 
“ee THIS NUMBER IS ROUNDED TO 7. TO REDUCE THE CUMULATIVE EFFECT OF 
hala THE ROUND OFF, EVERY 32 COUNTS ‘POSINC’ IS SET EQUAL TO 8. THIS 
ae AGAIN LEADS TO SOME CUMULATIVE ERROR, BUT THE SMALL ANGULAR RANGE 


@)7 


0010 


OOTE 


OOTF 


0020 
0021 


0022 


0000 
0080 


0080 


0080 
0081 


0082 
0084 
0085 
0086 
0088 


008A 


0080 


aad OF THE TILT ANGLE (10.5 DEGREES) ALLOWS US TO NEGLECT ANY FURTHER 
ree MODIFICATIONS. 


POSINC RMB 1 

Rt 

*** HYSTERESIS VARIABLES. USED TO ELIMINATE THE EFFECTS OF BACKLASH ON 
wae THE POSITION MEASUREMENTS. 


ext 


HYST RMB 1 THE THRESHHOLD VALUE DETERMINED 
tee) EXPERIMENTALLY. 
HYSTCT RMB 1 CURRENT AMOUNT OF HYSTERESIS MEASURED. 


ree 


*** STATUS BYTE. USED TO KEEP TRACK OF WHAT IS GOING ON. 


rere 


STAT RMB 1 CURRENT STATUS. 
LSTAT RMB 1 PREVIOUS/LAST STATUS. USED TO KEEP TRACK OF 
wee L_SET ONLY. 
eter 
*** TIMER COUNTER. USED IN CONJUNCTION WITH THE TIMER PRESCALER AND THE 
wre TDR TO KEEP TRACK OF ONE SEC. INTERVALS. USED IN BLINKING THE 
ee DISPLAY. INITIALLY SET TO 31, WHEN THE ‘FLASH’ BIT OF ‘STAT! 
tee IS SET. TIMCT IS DECREMENTED EACH CLOCK INTERRUPT (APPROX. 31 
ial TIMES PER SEC). RESET TO 31 WHEN CONTENTS GO TO ZERO. 
olaia WHEN (TIMCT)=0 THE DISPLAY WILL TOGGLE. 
xe 
TIMCT RMB 1 
ak 

ENDS 


xe 
kkk 
RECA ACKACARAAAAKARAAKRAKCKAKACAKACACKCKKKAKEKAAAAAAARAARRARAAAAEAAARRARARKEKKRARKKKAT 


re e 
baled PAGE ZERO ROM 
ae # 


REAACACACACAECACACACAACAAAKACACACACAACCACKCAKCCAKCAKAKEAKKAKAEEKEKERAEEREKEARERAEAAEEAERAEKAAAKKE 
Rk 


sted INITIALIZATION ROUTINE. 
ae 
xr 
CODE 
* 
ORG ZROM PAGE ZERO ROM. 
xe 
RELATIVE RELATIVE ADDRESSING MUST BE USED FOR THE BRANCH. 
* 
RESTRT EQU $ THIS IS THE ENTRY POINT WHEN AN EXTERNAL 
2% INTTERRUPT OCCURS. 


re 
REACACCCAKKCAACAAAAACECACACACACCACACKAKAAKKAAAAAAAAEAKAAKAKAKKAKAKAKAKAKKKAKAKEAKAKKKKKKEKEKAKE 
xe 


as INITIALIZE THE PC AND CLEAR RAM. 
eee 
eee 
SEI SET INTERUPT TO AVOID INTERUPTION AND 
RSP RESET THE STACK POINTER. JUST IN CASE! 
22k 
LDX #BINCT CLEAR ALL OF THE VARIABLES BETWEEN 
CLRIT CLR x 'BINCT’ AND ‘TIMCT’ (INCLUSIVE) .NOTE 
INCX THAT THIS SETS THE COUNTER AND THE POS- 
CPX #TIMCT ITION TO ZERO. THIS MEANS THAT ROTATION 
BLS CLRIT SHOULD START IN AN INCREASING (Ch) 
IO DIRECTION FROM THE MOST CCW POSITION 
a AFTER A RESET. 
eke : 
ABSOLUTE BACK TO ABSOLUTE ADDRESSING. 


xKxk 
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008C 
OO8E 


OO9A 
009C 
OO9E 


OOA0 


OOA2 


OOA4 
OOA6 


OOA8 
OOAA 


OOAC 


OOAE 
008 1 


A6 06 
B7 iE 
B7 iC 


A6 47 


B7 09 


A6é FF 
B/7 08 


A6é 1F 
B7 22 


1D OA 


CD 02 08 
ic 01 


RRA CAE EECA AAAEEEAEKCETEEEKCEEEEAEEKEKKEEKEEEKAKEEEEE 
ree 
ne ESTABLISH I/O PORTS. 
wkk 
LDA s#-1 PORTS A,B,C ARE CONFIGURED AS 
STA PORTA*DDR-=—s ALL_ OUTPUT. PORT D IS ALL INPUT 
STA PORTB+DDR = SO _ THERE IS NO MASK TO SET. 


STA PORTC+DDR 
wee 


SAREE AREAS AEE EAEAEEEERERREARAREEEKKER 


bala SET UP THE STATUS REGISTER. 
wee 
LDA #%00001000 -- 
AND PORTD |--> SET UP ‘L_SET’ BIT OF ‘STAT’. 
STA STAT °- 
wie 
BSET MOO_32,STAT O IS MODULO 32. 
ae 


RACECAR RERACEHCERAEAAEAEERERAEEEEERRERERRERRRRERREEREEREKEERERRKKKREK 


eee INITIALIZE HYSTCT. 


LDA #06 
STA HYST 
STA HYSTPT 


wae 
CONCERT RAR ARAE TREE H ERE HEHE PONTE TRH eee wee ee Re ce eee eee 
eo 

saad SET UP THE TIMER FOR A 4 MHZ CRYSTAL / 4 = 1 MHZ CLOCK. 

wae 

“lia NOTE: THE MASK OPTION REGISTER IS IN ROM. IT IS SET UP AT 

Saal THE END OF THE PROGRAM. 


Rk 
REAR REEAKAKEARKKKKEEE SET UP THE TCR. RECERCAT EKKKKKEE 
kik 


LDA #8116+BIT2+BIT1+BITO 
asi (TIM) | CPS2)(PS1)(PSO) 
***(D SABLE INTERRUPT) |(PRESCALE BY 128) 
exe 

STA TCR 
wk 
kkk 
*** SET UP THE TIMER. 
xk&n 

LDA #255 1 «MH2/(128*255) = 30.6 (APPROX. 31) 

STA TIMER 


xa 
RARKEKKKKKRKKKKKK INITIALIZE THE TIMER COUNTER. REAKRAKAKKEKKRHEKKKEKKEKKKEK 
eek 


LDA #31 PROVIDES FOR 1 SEC. BLINK INTERVAL. 
STA TIMCT FOR 2 SEC. INTERVAL JUST USE TIMECT=62, etc. 


Rk 

Rk 
RAKAEEKEKEKEKARRRREKEEREEKEKKREKEKEKRKKREEKRARKEKRERRERREKKKEEREREHRERKRHKEKKHKREK 
kk 


see SET UP MISCELLANEOUS REGISTER. 


at 

BCLR Bé,MR ENABLES THE SECOND INTERRUPT. 
aw 
(he 80 90 Ree fe Be e909 Re eB ee ee Foe ee ee ee ee er eee re We et ae eee ewe aie de ey 
wt 
ci COUNT = 0 IS DISPLAYED INITIALLY. 
tees 

JSR OUTCT 
BSET POSTIV,PORTB 


ak 


OS 


00B3 


00B4 


0084 


0087 
OOBA 
OOBC 
OOBE 
ooco 


00C2 
00c4 


00Cé 
ooc8s 
OOCA 
oocc 
OOCE 
0000 
0002 


0004 
0006 
0008 
OODA 
00DC 


OODE 
O0E0 
O0E2 


O00E4 
OOE5 
O00E7 


O0E9 
OOEB 
OOED 
OOEF 


OOF 1 
OOF3 
OOF6 


OOF8 
OOFB 
OOFE 
0100 
0102 
0104 


0107 
010A 


9A 


28 


04 


CLI 


RELATIVE 


art 
Rat 


RRC ECAR EERE EKE SEERA AEE 


tw 
** WAIT LOOP. 
ae 
PAUSE BRCLR 
ge 
BRSET 
BCLR 
BRA 
SBIT  BSET 
BRA 
ter 


RASCALS SEARS AEE EEA EERAAAEAAAEEREEANEH 


te 


CLEAR THE INTERRUPT MASK TO GET STARTED. 


RELATIVE ADDRESSING MUST BE USED FOR THE 
REMAINDER OF THE PROGRAM. 


EXECUTES, UNTIL AN INTERRUPT OCCURS. 


FUNCT,PORTO,CHHYST WANT TO CHANGE HYST? 


SET, PORTD, SBIT 


L_SET,STAT 
PAUSE 
L_SET, STAT 
PAUSE 


** HYSTERESIS MODIFICATION ROUTINE. 
** HYSTERESIS BUFFER WITHOUT REPROGRAMMING. 


rx 


CHHYST LDA 
STA 


rxer 


wax 


Rex 


RR 


DISPLA LDA 


rere 


Rex 


SIGN 
DIR BRSET 


2x 


#B1T6 
TCR 


#%00001000 
STAT 

LSTAT 
#%00001000 
POR TD 
LSTAT 
DISPLA 


#%00001000 
STAT 

STAT 

HYST 
HYSTPT 


HYSTPT 
#25 
DISPLA 


HYST 
HYSTPT 


#¥%00000000 
PORTA 
¥%11000000 
PORTB 


HYSTPT 
TABLE ,X 
PORTC 


FUNCT,PORTD,CHHYST WC... 
NEGTIV,STAT,SIGN 
POSTIV,PORTB 


DIR 


POSTIV,PORTB 
POSCT, STAT, SHOPOS 


OUTCT 
DUNCHG 


110 


YES...GO TO CHHYST. 


WO... "SET,PORTD’ SET? 
WO...CLEAR ‘L_SET,STAT! 

AND LOOP. 
YES...SET ‘L_SET,STAT! 

AND LOOP. 


PERMITS MODIFICATION OF THE 


YES--- 


DISABLE TIMER INTERRUPT. 


SAVE ‘L_SET’ 


INTO 
‘LSTAT’. 


‘SET,PORTD’ --> ACCUMULATOR 
HAS THE SET SWITCH BEEN CHANGED? 


YES. oe 


|-->CHANGE ‘L_SET,STAT’, 


THEN INCREMENT THE HYSTERESIS 


POINTER AND 


-- BUT NOT ABOVE 25. 


-- DISPLAY CURRENT 


SHYST’ 3. 


‘HYST’. 


IS ‘HYST’ SETTING COMPLETE? 


KEEP CHECKING 
YES... RESET THE DISPLAY. 


SETS. 


010C 


010F 
0112 
0114 
0116 


0118 


O11A 
011D 
0120 


0122 
0124 
0126 


0127 
0129 
012C 


012D 
012F 
0131 
0133 


0135 
0138 


0139 


013¢ 


O13E 
0140 


CD 02 


0B 20 
A6é 07 
B7 09 
20 9C 


0139 
OF 09 
1F 09 


3A 22 
27 01 


E> 


04 


10 
07 


D8 


DC 


Rk 


SHOPOS JSR OUTPOS 

wee 

DUNCHG BRCLR- FLASH,STAT,NO_INT IF THE DISPLAY IS TO BLINK... 
LDA #81T2+BIT1+BITO ENABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER 

NO_INT BRA PAUSE PRIOR TO RETURNING. 


tte 
wk 
RARER AEAAARERAEAEEEEEEAERAAEREAEEEEEEEAEEREAAEREEREEEEEE ARAN 


** MAXIMUM EXECUTION TIME FOR THE REMAINOER OF THE PROGRAM OCCURS 

** IF THE COUNTER ROTATES THROUGH ZERO AS THE DISPLAY MODE IS CHANGED 
** FROM THE BLINKING MODE TO THE COUNT MODE AT THE SAME TIME THAT THE 
** BLINKING ROUTINE IS CAUSING THE DISPLAY TO TOGGLE TO SHOW THE 

** POSITION IN DEGREES. 

te MAXIMUM EXECUTION TIME = 67 + 140 + 618 = 825 CLOCK CYCLES. 


tk 
HAE AAAERAEEAEEEEREERAEEEEREREEREREREEEEAEEREEEEEEEEEEEEEREREEEEEEREEEEE 
tt 


**MODE CHANGE ROUTINE. CHANGES THE DISPLAY MODE FROM 


baad COUNT -> POSITION -> BLINKING -> COUNT ->....(ETC.) 

me MAXIMUM EXECUTION TIME OF 127 CLOCK CYCLES OCCURS WHEN THE 

i DISPLAY MODE IS CHANGED FROM DISPLAYING THE COUNT TO DISPLAYING 
iad THE POSITION CIN DEGREES). 

*8 IF THE DISPLAY IS CHANGED FROM BLINKING TO A COUNT DISPLAY 

=* EXECUTION TIME IS 67 CLOCK CYCLES. 

we 

CHMODE BCLR B7,MR AVOID REPEATED INTERRUPTS. 

rk 


BRSET  FLASH,STAT,DIS_CT IF FLASHING, DISPLAY COUNT... 
BRCLR POSCT,STAT,DISPOS IF SHOWING COUNT, DISPLAY POSITION... 


BSET FLASH, STAT ELSE, BLINK. 
we : 
LDA #B1T2+B1T1+BITO ENABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER. 
RTI 
we 
DISPOS BSET  POSCT,STAT -- 
JSR OUTPOS |-- DISPLAY CURRENT POSITION, AND WAIT. 
RTI -- 


tk 


DIS _CT LDA #BITG+B1T2+BIT1+BITO DISABLE TIMER INTERRUPT AND RESET 
STA TCR TIMER PRESCALER. 
BCLR  POSCT, STAT -- 
BCLR FLASH, STAT | 

** |-- DISPLAY CURRENT COUNT, AND WAIT. 
JSR OUTCT | 
RTI -- 


wt 
RAKRKEKKKEKKEKEKEEEKCKEKKEKKAAEREKKEEKEEREKEKAREERAEKEKCKEKEKEKREKERKKKKKKKKE 
wr 


** BLINK ROUTINE. INTERRUPT ROUTINE TO CHANGE THE DISPLAY FROM POSITION 


we TO COUNT OR VICE VERSA EVERY 31 ST TIMER INTERRUPT IF THE 
we “FLASH! BIT OF ‘STAT’ IS SET. 
ae MAXIMUM EXECUTION TIME OF 140 CLOCK CYCLES OCCURS WHEN THE 
wx DISPLAY IS TOGGLED FROM A COUNT DISPLAY TO A POSITION DISPLAY. 
ae 
BLINK  €QU $ 

BRCLR =TIR,TCR,CHMODE IF THE INTERRUPT WAS NOT A TIMER 
fF INTERRUPT IT MUST BE FROM INT2. 
ke 

BCLR TIR, TCR AVOID REPEATED TIMER INTERRUPTS. 
kk 

DEC TIMCT IF THERE HAVE BEEN 31 TIMER 

BEQ CHGDIS INTERRUPTS (1 SEC), IT’S TIME TO 
as CHANGE THE DISPLAY. 


Wakal 


0142 


0143 
0145 


0147 
0149 
014B 


0140 


0150 
0153 


0154 
0157 


0158 
015B 


015¢C 
015E 
0160 
0162 
0164 


0166 
0168 


016A 


0158 
OA 03 01 
80 


AG 7F 
B4 20 
B7 20 
A6é 80 
B4 03 


BA 20 
B7 20 


OF 20 09 


RTI OTHERWISE, IT’S BACK TO WORK. 
rn 
CHGOIS LDA #31 RESET TIMCT TO 31 (1 SEC. INTERVAL). 
STA TIMCT 
we 
LDA STAT == 
EOR #%000 10000 |-- CHANGE ‘POSCT’ BIT OF ‘STAT’. 
STA STAT a 
we 
BRSET POSCT,STAT,POSOUT DECIDE ON CORRECT DISPLAY. 
we 


weesererenes CHANGE THE DISPLAY TO SHOW THE COUNT..... “"@*"=SEEEGe 


JSR OUTCT 
RTI 


ee 


seeeeeneeees Op HAVE THE DISPLAY SHOW THE POSITION, ‘**#***eeeeennennes 
re 
POSOUT JSR  QUTPOS 

RTI 


ee 
RAAT CE REECE REEREEEEEEECEEKEAEKCEEKCREKEREAAAEREKKEKEAEREKEEE 
rk 


a COUNT ROUTINE. 

sca WHEN A COUNT IS RECEIVED THIS IS THE ENTRY POINT . 

salad MAXIMUM EXECUTION TIME OF 618 CLOCK CYCLES OCCURS WHEN THE 

fi COUNTER ROTATES CCW THROUGH ZERO AND THE POSITION (IN DEGREES) 
us IS BEING DISPLAYED. 


** CURRENT DIRECTION OF ROTATION IS DETERMINED BY INSPECTING THE STATUS 
** OF ‘CH_A’ AND ‘CH_B’. THE FOUR POSSIBILITIES AND THE ASSOCIATED 

** DIRECTION OF ROTATION ARE AS SHOWN BELOW. NOTE THAT THIS SCHEME 

** PREVENTS MULTIPLE OSCILLATIONS ABOUT A SINGLE POINT FROM 

** REPEATEDLY INCREMENTING OR DECREMENTING THE COUNTER. 


we $ooccee-- Se Heer eee we ew ee eence Heer eee eee ee seeeeees + 
** | CHA | CHB | DIRECTION | COUNT THE PULSE? | 
es | | | OF ROTATION | | 
belied Hoon eee- Se Here ewe e eee ern ceeee to eee eer ence meee eeee + 
6 Oe Cae CW | NO | 
“* | Lo | HI | CCW | YES | 
** | HI | Lo. | CCW NO | 
ee | HI | CW | YES | 
badiad torre ---- Hoon eeee-- 0 Hore cere ere mee eens + 


wx 


seeeeees FIRST SEE IF WE ARE SUPPOSED TO COUNT THIS INTERUPT. *****##* 


we 


COUNT EQU $ 
BRSET CH_B,PORTD,OKCT IF CH_B IS LO WE DON’T COUNT THE 
RTI INTERRUPT. 


wr 


seeeeeeeeeeees TF THE INTERRUPT IS VALID UPDATE ‘STAT’, *##eeeeneenens 


wR 


OKCT LDA ¥%01111111 


AND STAT SAVE ALL OF THE OLD ‘STAT’ EXCEPT THE 

STA STAT DIRECTION OF ROTATION. 

LDA #% 10000000 

AND POR TD ‘CH_A,PORTD’ INDICATES THE DIRECTION 
a OF ROTATION AND BECOMES ‘UO,STAT’. 

ORA STAT ADD THE RESULTS TO GET 

STA STAT THE NEW ‘STAT’. 


re 


** DECIDE IF THE "SLACK" DUE TO BACKLASH/HYSTERESIS HAS BEEN TAKEN OUT. 


Rk 


BRSET UO,STAT,HYSTCK IF ROTATING Cw SEE BELOW. 


12 


0160 
O16F 


0171 
0173 
0175 


0176 
0178 
O17A 
017C 
O17E 


O17F 


CD 02 32 


CD 02 7A 


LDA 
BEQ 
ah 
SUB 
STA 
RTI 
at 
HYSTCK LDA 
CMP 
BEQ 
INC 
RTI 


ee 
at 


HYSTCT 
CCW 


#1 
HYSTCT 


HYST 
HYSTCT 
Cw 
HYSTCT 


ELSE, SEE IF WE DECREMENT THIS TIME. 

IF HYSTCT=0, GO TO THE COUNT DOWN 
ROUTINE. 

ELSE, DECREMENT THE HYSTERESIS COUNTER, 


AND WAIT FOR THE NEXT INTERRUPT. 


IF ROTATING CW.... 

AND HYST = HYSTCT .... 

COUNT THE PULSE . 

ELSE, INCREMENT THE HYSTERESIS COUNTER, 
ANDO WAIT FOR ANOTHER PULSE. 


REREEEARAAAEAEEERAREEREEEEEE EEE EERE RETA AEEEARREEHEREEREARERERERERREEKEE 


Cw EQU 


rt 
Rank 


HRAAKKRKAKAKKKEEE 


wax 


kek 


kak 
weak 


RRAKAEARKREKREKEKEEH 


kak 


LDA 
AND 
BNE 
Rak 
BSET 
BRA 
nak 
NOT_32 BCLR 
xazx 
xen 


DIRCHK LDA 
BMI 


aah 
kak 


BNE 
LDA 
BNE 


xxx 


BCLR 
kak 
LDX 
CLRIT2 CLR 
INCX 
CPX 
BLS 
BRA 
Kak 
CWPOS BSR 
JSR 
BRA 


kak 


CWNEG JSR 


CLOCKWISE ROUTINE. 


INCREMENT THE BINARY COUNTER (BINCT). 


RAERRAEKREREEEEEEEK 


LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 
#1 LOBIN = LOBIN + 1 ; CARRY -> C,CCR 

LOBIN 

HIBIN 

#0 ADD THE CARRY TO THE HIGH BYTE. 
HIBIN 


LOBIN 
#%00011111 
NOT_32 


MOD_32,STAT 
DIRCHK 


MOD_32,STAT 


HIBIN 
CWNEG 


CWPOS 
LOBIN 
CWPOS 


NEGTIV, STAT 


#PTR3S + 
X cas 


#THOUTH = -- 
CLRIT2 -- 
UPOUT 
ADDBCD 
INCPOS 
UPOUT 


SUBBCD 


i153 


CLR/SET MOD_32 APPROPRIATELY. 


RHERRRAREREKARREREREKREEK 


IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 


NOT THEN THE NUMBER ISN’T A MODULO 32 NUMBER. 


IF HIBIN < 0 , WE’RE ROTATING CW TOWARD 
THE ORIGIN. 


ELSE IF BINCT .NE. O, 
WE’RE ROTATING CW 
AWAY FROM THE ORIGIN. 
ELSE, WE’VE GONE THROUGH ORIGIN IN CW 
DIRECTION. CLR NEGATIVE SIGN. 
--RESET ALL COUNTERS AND DEGRES TO ZERO. 


UPDATE OUTPUT. 


0187 
O1BA 


01BC 
O1BE 
01C0 


01C2 
01C4 


01C6 


01c8 
O1CA 
O1CC 


O1CE 
0100 
0102 


0104 
0106 


0108 
O1DA 
010C 
O1DE 
01E0 
O1E2 


O1E4 
O1E6 
O1E7 
O1E8 
O1EA 


O1EC 
O1EE 
O1F1 


O1F3 
O1F6 


CO 02 9A 
20 30 


01BC 


O1F9 


JSR 
BRA 


gree 
kk 


DECPOS 
UPOUT 


RRAERAERRARARARAARAARAARAERAAEARARAKAREARARAARAAEAAAEALERAEEKAAERARAATAEAEEEARAAKAKAARKREREEE 


CCw EQU 


ef 
ere 


SERRATE AAAAEARAEEEE 


Rew 


RR 


NO_32 


Rk 
exe 
REKAREAEARAKERAKK 
eak 


DECBIN LDA 


Rak 


zk 


xn 


xk 


CCWNEG BSR 


ek 


CCWPOS JSR 


ae 


COUNTER-CLOCKWISE ROUTINE. 


LOBIN 


#%00011111 


wo_32 


CLR/SET MOO_32 APPROPRIATELY. 


ERAATATKAAKRARARAATEEEE 


IF THE LOW FIVE BITS OF ‘LOBIN’ ARE NOT 
ZERO THEN THE WUMBER ISN’T A MODULO 32 NUMBER. 


MOO_32,STAT 


DECBIN 


MOD_32,STAT 


DECREMENT THE BINARY COUNTER (BINCT). 


REREAKREARAREKREKEE 


LOBIN BEGIN AT THE LSB OF THE BINARY COUNTER. 
#1 LOBIN = LOBIN - 1 ; BORROW -> C,CCR 
LOBIN 
HIBIN 
#0 SUBTRACT THE CARRY FROM THE HIGH BYTE. 
HIBIN 
HIBIN 
CCWROS IF HIBIN .GE. 0 , WE’RE ROTATING CCW TOWARD 
THE ORIGIN. 
#-1 -- 
CCWNEG -- ELSE IF BINCT .NE. -1, 
LOBIN --WE’RE ROTATING CCW AWAY 
#-1 -- FROM THE ORIGIN. 
CCWNEG -- 
NEGTIV,STAT ELSE, WE’VE GONE THROUGH ORIGIN IN CCW 
DIRECTION. SET NEGATIVE SIGN. 
AND SET ALL COUNTERS APPROPRIATELY. 
#PTR3 0 -- 
X a 
-- RESET ALL COUNTERS AND DEGRES TO ZERO. 
#THOUTH = -- 
CLREM -- 
ADDBCD 
INCPOS 
UPOUT 
SUBBCD 
DECPOS 


KRAEAKAAAKEEEAAKERREKEEKEEKEEEKERRAEERERAEERAEREKKEEEEKAEEEAEEKEKEEEEEREERRREERREEK 


“x 


** OUTPUT ROUTINE. ROUTINE TO PRINT DATA TO THE OUTPUT PORTS. BY 


= CALLING THE APPROPRIATE SUBROUTINE.C’OUTCT’ TO OUTPUT THE 
* THE COUNT AND ‘OUTPOS’ TO OUTPUT THE POSITION). 

t 

UPOUT EQU $ 


114 


O1F9 
O1FC 
O1FE 


0200 
0202 


0205 
0208 


0209 
020C 


0200 
O20F 
0211 
0213 
0215 
0217 
0218 


O21A 
021B 
021D 


O21E 
0221 
0223 


0225 
0227 
0229 
022B 


O22C 
O22F 


0231 


0232 


0235 
0237 


0239 
0238 


0230 
O23F 
0241 
0243 


23 


E5 


d8 


28 


28 


04 


BRSET NEGTIV,STAT,MINUS -- 
BSET  POSTIV, PORTB -- 
BRA DISCHK -- 
we -- SET THE NEGATIVE SIGN 
MINUS BCLR  POSTIV,PORTB -- APPROPRIATELY. 


we 


DISCHK BRCLR POSCT,STAT,PUTCT 
re 
JSR OUTPOS 
RTI 
ee 
PUTCT JSR OUTCT 
RTI 


we 
RHA KEA AEA EEEEREAEEE TEETER AEREAEEEEAEARAEEREAEEEEEAERAEEEAEREEHEEEE 


weweenaneee SUBROUTINE TO INCREMENT THE BCD COUNTER (BCOCT). ‘*****¥*¥#* 


wie 


ADDBCO LDA CTPTR1 


ADD #1 
CMP #99 CTPTR > 99 ? 
BLS OK1 NO, WERE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
SUB #100 YES... MODIFY THE CTPTR, 
SEC SET THE CARRY, AND 
BRA OK1A USE TABLE LOOK UP. 
xk 
OK1 CLC NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK1A STA CTPTRI -- 
TAX -- 
tee -- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X  -- 
STA TENONE -- 
BCC NOMO AND CONTINUE ONLY IF THERE WAS A CARRY. 
ekxnr 
kke 
LDA CTPTR2 
ADC #0 ADD THE CARRY. 
STA CTPTR2 -- 
TAX -- 
wee -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X -- 
STA HUNDRD -- 
ere 
NOMO —_rRTS 


bee 
eee ea eae ef ee We ee ee ee ee eee ee in eer eae eke ie 
*eeeee* €SUBROUTINE TO INCREMENT THE POSITION COUNTER (DEGRES). ‘******* 
see 

**** FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MOOULO 32 
nee NUMBER. 


kkk 


INCPOS BRCLR MOD_32,STAT,INC7 ‘MOD 32,STAT’ SET ? 


krak 


LDA #e YES |... 

BRA INC INCREMENT THE POSITION BY 0.008 DEGREES. 
wits 
INC7 LDA #7 NOM. - 


INC STA POSINC INCREMENT THE POSITION BY 0.007 DEGREES. 


wank 


**** ROUTINE TO INCREMENT THE POSITION COUNTER ,’DEGREES’,BY A 


tree PREDETERMINED AMOUNT, ‘POSINC’. 
kkenk 

LDA PTR1 

ADD POSINC 

CMP #9 PTR1>9? 


BLS OK3 NO, WE’RE OK HERE. LOOK UP THE FIRST DIGIT. 


a 


0245 
0247 
0248 


024A 
0248 
0240 


O24E 
0251 
0253 


0255 
0257 
0259 
0258 
025D 
O25F 
0260 


0262 
0263 
0265 


0266 
0269 
0268 


0260 
O26F 
0271 
0273 


0274 
0277 


0279 


OA 


01 


28 


28 


28 


28 


28 


SUB #10 YES... MODIFY THE CTPTR, 
SEC SET THE CARRY, AND 
BRA OK3A _-USE TABLE LOOK UP. 


OK3 Cre NWO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK3A STA PTR1 “2 

TAX s 
—* -- LOOK UP THE LEAST SIGNIFICANT DIGIT. 


BCC DONE AND CONTINUE ONLY IF THERE WAS A CARRY. 
een 
tent 

LDA PTR2 

ADC #0 ADD THE CARRY. 


CMP #99 PTR2 > 99? 

BLS OKs WO, WE'RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
SUB #100 YES... .MODIFY THE CTPTR, 

SEC SET THE CARRY, 

BRA OK4A AND USE TABLE LOOK UP. 


geen 


OK4 CLC NO CARRY EXISTS IF WE ENTER AT THIS POINT. 
OK4A STA PTR2 = -- 
TAX -- 
news -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X -- 
STA HUNDTH -- 
BCC DONE AND CONTINUE ONLY IF THERE WAS A CARRY. 
Rea 
exer 
LDA PTR3 
ADC #0 ADD THE CARRY. 
STA PTR3 == 
TAX -- 
slalaha -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X  -- 


STA ONEDEG -- 


RRKK 
DONE RTS 
arn 
aK 
RRAAAAKKKKAEKRKRERKRKRKRKRAEAAEERRAAARAAAARKAAEEKEKKKAEKAAKAAKKKAKKAKKKKEKEKKEKKKKEEE 
seeeeee* SUBROUTINE TO DECREMENT THE BCD COUNTER (BCDCT). *****#eeeeee 
Rak 
SUBBCD LDA CTPTR1 
SUB ts#1 CIPTR > 99 ? 
BCC  OK6 = NO, _-WERE OK HERE. LOOK UP THE FIRST TWO DIGITS. 
ADD (#100 YES, MODIFY THE CTPTR, AND 


SEC GENERATE A BORROW. 
xxx 
OK6 STA CTPTRI -- 
TAX -- 
nee -- LOOK UP THE TWO LEAST SIGNIFICANT DIGITS. 
LDA TABLE,X  -- 
STA TENONE -- 
BCC COMPLT AND CONTINUE ONLY IF THERE WAS A BORROW. 
XXX 
xx 
LDA CTPTR2 
SBC #0 SUBTRACT THE CARRY. CTPTR > 99 ? 
STA CTPTR2 -- 
TAX -- 
ae -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 
LDA TABLE,X -- 
STA HUNDRD  -- 


Rak 


PVG 


0299 


O29A 


0290 
O29F 


O2A1 
02A3 


02A5 
02A7 
O2A9 
O2AB 
O2AD 


O2AE 
0280 


0281 
0284 
0286 


0288 
O2BA 
O2BC 
O2BE 
02C0 


02C1 
02C3 


02C4 
02C7 
02c9 


02CB 
02CD 
O2CF 
02D 1 


02D2 
02D5 


0207 


81 


28 


28 


28 


COMPLT RTS 


ean 

PERERA AEAREE REA ERE AREER AEA EEE AERA EEA AAA AAA REAR AAA A REE EEE 
weaken SUBROUTINE TO DECREMENT THE POSITION COUNTER (DEGRES). ******* 
een 

weee FIRST CHECK TO SEE IF THE BINARY COUNTER HAS REACHED A MOOULO 32 
alia ali NUMBER. 


eee 


DECPOS BRCLR MO0D_32,STAT,DEC7 *MOD_32,STAT’ SET ? 


rene 
LDA #8 YES... 
BRA DEC DECREMENT THE POSITION BY 0.008 DEGREES. 
reese 
DEC? LDA ¥7 WO .... 
DEC STA POSINC DECREMENT THE POSITION BY 0.007 DEGREES. 
tees 


**** ROUTINE TO DECREMENT THE POSITION COUNTER ,’DEGREES’,BY A 
weet PREDETERMINED AMOUNT, ‘POSINC’. 


Rkeee 


SUB POSINC PTR1 <0 ? 
BCC OK8 NO, WE’RE OK HERE. LOOK UP THE FIRST DIGIT. 


ADD #10 YES, MODIFY THE CTPTR, AND 
SEC GENERATE A BORROW. 
kere 
OK8 STA PTR1 
TAX -- 
ahaha -- LOOK UP THE LEAST SIGNIFICANT DIGIT. 
LDA TABLE,X -- 
STA THOUTH -- 
BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A BORROW. 
zen 
eek 
LDA PTR2 
SBC #0 SUBTRACT THE BORROW. PTR2 < 0 ? 
BCC OK NO, WE/RE OK HERE. LOOK UP THE NEXT TWO DIGITS. 
ADD #100 YES, MODIFY THE CTPTR, AND 
SEC GENERATE A BORROW. 
kee 
OK9 STA PTR2 
TAX -- 
aes -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


BCC DUNSUB AND CONTINUE ONLY IF THERE WAS A CARRY. 
keer 
ree 

LDA PTR3 

SBC #0 SUBTRACT THE BORROW. 

STA PTR3 

TAX -- 
fees -- LOOK UP THE NEXT TWO DIGITS IN THE TABLE. 


wey 
DUNSUB RTS 

ried 

ee 

ae 

RERRARARAARAREA RARER ARERR ARERR EEEAEAEREEEEEEEEAEEAEREENEE ERE EES 
at 


** OUTPUT COUNT (OUTCT). SUBROUTINE TO MOVE THE CURRENT COUNT (BCDCT) 


ished TO THE OUTPUT PORTS. REMOVES THE DECIMAL POINT FROM THE 
ae DISPLAY AND BLANKS ALL BUT THE LEAST SIGNIFICANT DIGIT. ALSO 
ha SETS THE MINUS SIGN IF APPROPRIATE. 


ke 


di 


0208 
O2DA 


020C 
O2DE 


O2E0 
O2E2 


O2E4 


O2E5 
O2E7 
O2E9 
O2EB 
O2ED 
O2EF 
O2F 1 
O2F3 
O2F5 
O2F7 
O2F9 
O2FB 


O2FD 
O2FF 
0301 


0302 
0304 
0306 
0308 
030A 
030C 
030E 
0310 
0312 


0314 
0316 


0318 
O31A 
031C 


031D 
031F 
0321 


0323 
0325 


0327 


0208 


Bé 1B 
87 O02 


B& 1A 
87 00 


1E 01 
19 01 


81 


OUTCT EQU $ 
et 
LDA TENONE 
STA PORTC 
we 
LDA HUNDRD 
STA PORTA 
ee 
BSET DECPT,PORTB 
BCLR BLANK, PORTB 
we 
RTS 
we 
Eee TEAR ERE REE AEE EERE EEE TATE EERE EER 
we 


** QUTPUT POSITION (OUTPOS). SUBROUTINE TO MOVE THE CURRENT POSITION 
sabe COUNT (BCOCT) TO THE OUTPUT PORTS. THE DECIMAL POINT IS 
= DISPLAYED , ANO OWLY THE MOST SIGWIFICANT DIGIT IS BLANKED. 


Xk 


OUTPOS EQU $ 
en 


LDA THOUTH -- 


CMP #5 >. 
BLO TRUKC -- IF 5 > ‘THOUTH’ SIMPLY TRUNCATE THE 
LDA HUNDTH -- DISPLAY. OTHERWISE... 
AND #9 -- IF THE LAST DIGIT ISN/T A NINE IT IS 
CMP #9 -- EASY TO ROUND UP. JUST ADD A ONE. 
BNE DECIMAL -- 
LDA HUNDTH -- BUT IF THE LAST DIGIT IS A NINE CHECK TO 
CMP #399 -- SEE IF IT'S 99. IF SO IT GETS GRIM. 
BEQ UGLY -- 
ADD #7 -- IF THE NUMBER IS X9 AND X .NE. 9, THEN 
BRA PCOUT -- JUST ADD SEVEN TO ROUND UP. DUE TO 
aha -- HEXIDECIMAL. 
aha -- IF THE LOW TWO DIGITS ARE BOTH NINES 
UGLY LDA #00 -- AND WE NEED TO ROUND UP.... 
STA PORTC -- MAKE THE LOW TWO DIGITS BOTH ZEROS 
SEC -- AND SET THE CARRY. 
xk 
LDA ONEDEG -- CHECK THE LAST DIGIT AS BEFORE. 
AND #9 -- IF USING THIS PORTION OF THE CODE 
CMP #9 -- THERE HAD TO BE A CARRY. 
BNE NEXT -- IF THE LAST DIGIT IS A NINE DO THE 
LDA ONEDEG -- CARRY HERE. IF NOT USE THE ADC 
ADD #7 -- INSTRUCTION TO TAKE CARE OF IT 
BRA PAOUT = -- BELOW. 
DECIMAL LDA HUNDTH -- 
ADD #1 -- 
“* -- THIS IS ALL THAT NEEDS TO BE DONE IF 
STA PORTC -- THE LAST DIGIT IS NOT A NINE. 
BRA NEXT ==> 
RK 
TRUNC LDA HUNDTH -- 
PCOUT STA PORTC -- AND IF THERE IS NO CARRY IT’S EVEN EASIER. 
CLC -- 
xe 
NEXT LDA ONEDEG 
ADC #0 
PAOUT STA PORTA 


ae 


BSET BLANK, PORTB 
BCLR DECPT, PORTB 
we 
RTS 
er 
MITT TTT TTT TT TTT Tit Tit titi titi iii ii titi sti i tai i 


118 


038C 


OF38 
OF38 


OFF8 


OFFS 
OFFA 
OFFC 
OFFE 


1000 


Lines Assembled : 


00 01 
05 06 
10 11 


15 16 17 18 19 


20 21 


25 26 27 28 29 


30 31 
35 36 


07 


0139 
0158 
0158 
0080 


kk 


** SET UP THE TABLE TO BE USED WITH BCD INCREMENT/DECREMENT ROUTINES. 


ak 
* 
x 


TABLE 


ENDS 
DATA 

FCB $00 , $01, $02,$03, $04, $05 ,$06,$07, $08, $09 
FCB $10,$11,$12,$13,$14,$15,$16,$17,$18,$19 
FCB $20, $21,$22,$23,$24, $25 ,$26,$27,$28, $29 
FCB $30,$31,$32,$33,$34, $35, $36,$37,$38,$39 
FCB $40,$41,$42,$43, $44, $45 , $46,847, $468, $49 
FCB $50,$51,$52,$53,$54 $55 ,$56,$57,$58, $59 
FCB $60 ,$61,$62, $63 , $64 , $65 , $66, $67, $68, $69 
FCB $70,$71,$72,$73,$74,$75,$76,$77 ,$78,$79 
FCB $80, $81,$82,$83,$84,$85, $85, $87, $88, $89 
FCB $90,$91,$92,$93,$94, $95, $96, $97, $98, $99 
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SET UP MASK OPTION REGISTER. 


ABSOLUTE JUST TO ENSURE THAT THE INTERRUPT VECTORS 
ARE CORECTLY LOCATED. 


ORG MOR 

FCB #81T2+B1T1+B1TO 

COMMENTS: 

BIT 7 CLOCK SOURCE 0 = CRYSTAL. 

BIT 6 TIMER OPTION O = INTERNAL. 

BIT 5 TIMER/CLOCK SOURCE 0 = INTERNAL. 

BIT 4 NOT USED. 

BIT 3 NOT USED. 

BIT 2 SET - 

BIT 1 SET  - PRESCALE SELECT 111 => 128 

BIT O SET - 

AREER KEEREEEKREEARRERAEKEEKEEEKEKEAEKREKERAKEEAEAEEEEEEREREKREKKES 

ASSIGN INTERRUPT VECTORS. 

ORG INTRPT 

FDB BLINK TIMER/INT2 INTERRUPT VECTOR. 

FDB COUNT EXTERNAL INTERRUPT VECTOR. 

FOB COUNT SOFTWARE INTERRUPT VECTOR, NOT USED. 

FDB RESTRT RESET VECTOR. 

ENDS 

END 
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Assembly Errors : 0 
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